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SUMMARY 

During the period of this report, from May 16 to November 15, 1989, work continued 
on (1) control for bracing of light weight arms and (2) modeling of closed chain flexible 
dynamics. Work on (3) control of a small arm mounted on a large flexible arm to meet 
demanding application requirements was supported for the first time, although the work 
has been in progress for some months. 

Mr. Dong-Soo Kwon has been looking at control for the bracing strategy. His early 
work concluded that trajectory planning must be improved to best achieve the bracing 
motion. He has now achieved very interesting results which enable the inverse dynamics of 
flexible arms to be calculated for linearized motion in a more efficient manner than 
previously published. The desired motion of the end point beginning at t = 0 and ending at 
t = t f is used to calculate the required torque at the joint. The solution is separated into a 
causal function that is zero for t < 0 and an accusal function which is zero for t > tf. He 
has explored a number of alternative end point trajectories in terms of the peak torque 
required, the amount of anticipatory action, and other issues. The single link case is the 
immediate subject of this study, and an experimental verification of that case is being 
performed. An abstract was submitted to the 1990 American Control Conference and that 
paper is now in preparation. 

Modeling with experimental verification of closed chain dynamics continues and will 
soon result in the Ph.D. thesis of Mr. Jeh-Won Lee. Mr. J-W Lee is no longer supported 
under this grant since he is completing his thesis while employed at the NASA Marshall 
Space Flight Center. His work there is closely related to the thesis work carried out with 
this NASA Grant. His modeling effort has pointed out inaccuracies that result from the 
choice of numerical techniques used to incorporate the closed chain constraints when 
modeling our experimental prototype RALF (Robotic Arm Large and Flexible). Since he 
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is comparing his results to TREETOPS, a multi body code developed for and used by 
NASA, direct improvements in the NASA modeling capabilities are expected. The 
experimental verification work is suggesting new ways to make comparisons with systems 
having structural linearity and joint and geometric nonlinearity. Mr. J-W Lee should 
complete his Ph.D. degree in the first quarter of 1990. 

Work on the small arm mounted on a large arm currently involves three students. 
Mr. Soo-Han Lee has been studying the generation of inertial forces with a small arm that 
will damp the large arm’s vibration. Since the centralized control is complex to implement 
and dependent on close coordination for stability (hence less robust) he has concentrated 
recently on a "nearly decoupled" control. Decoupling is enhanced by the proper 
configuration of the small arm. During the large arm motions this is reasonable, since the 
small arm may not have a specified configuration. When the small arm configuration is 
specified by the task other approaches may be necessary. Experimental verification using 
the planar motions of RALF, a 20 ft arm, and SAM (Small Articulated Manipulator), a 3 
degree of freedom arm, are proceeding. The control computer interfaces have now been 
constructed. These experiments should begin in early 1990. 

Mr. Jae Lew has orally presented his Ph.D. thesis proposal and is making several 
adjustments to the draft document. He is studying the control and coordination problems 
that arise in task execution using a small and large arm combination like RALF and SAM. 
The disparate size of these arms and the serial mounting challenge us to use the advantages 
of each arm most effectively to provide reach, precision, payload and speed improvements. 
Existing approaches for redundant and dual arms are relevant, but not directly applicable. 
In particular, by attaching the heavy payload to the large arm at the same point the small 
arm is attached, a topology similar to the construction crane results. The small arm can 
make precise adjustments to the payload position much as the construction worker places 
the crane’s load by pushing on it. 

Mr. Jonathan Cameron joined the project in the Fall quarter. He has now successfully 
completed his qualifying exams and will be studying the multiple arm dynamics and 
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coordination problem. His experience in the space program at JPL and his computer 
experience make him an immediately valuable team member. 

Previous researchers under this grant are continuing to publish papers on the 
research it supported. Dr. Bau-San Yuan, currently with American Semiconductor 
Equipment Technologies, has co-authored papers on his control results, and the draft of a 
paper on symbolic modeling has been prepared. Dr. Sabri Cetinkunt, now at the University 
of Illinois, Chicago, has submitted and published papers to several journals as documented 
in the following. 
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RESEARCH TOPIC: Control of a Flexible Bracing Manipulator 
RESEARCH ASSISTANT: Dong-Soo Kwon 

SHORT TERM OBJECTIVE: Inverse Dynamics Calculation for Following The Desired 

End Point Trajectory 

1) INVERSE DYNAMICS 

An inverse dynamic equation is derived from the direct dynamic equation of a flexible 
one-link manipulator using the assumed mode method. The required torque for a certain 
desired trajectory is obtained by synthesizing two solutions of the causal part and the 
anticausal part of the inverse dynamic equations. Applying the calculated torque to the 
ideal model of the system as open loop, the reference values of all state variables, which 
match the desired end point trajectory, are provided. These can be used as reference 
command values of all state variables for full state feedback tracking control. The 
characteristics and the performance of the open loop control and the combination of the 
open loop feedforward control and feedback control are studied in simulation and 
experiment. 

2) EXPERIMENTAL EQUIPMENT 

To implement the torque profile which was obtained from the inverse dynamics, a 
flexible 47" long aluminum single link manipulator is setup with a direct DC servo motor 
and a current amplifier. Two strain gauges are attached at the base and the mid point of 
the beam to measure the flexible vibration. A joint angle position sensor and a 
tachometer are attached at the shaft of the motor. At the end of the beam, a mass is 
attached to model the payload, and a force sensor is installed to measure the contact force 
for bracing applications. 
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PUBLICATION 

The abstract of the paper "A Causal Approach to The Inverse Dynamics of a Flexible 
Link Arm" was submitted to the 90’ American Control Conference. 
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RESEARCH TOPIC: Modeling of the Constrained Dynamics of a Flexible Robot 
RESEARCH ASSISTANT: Jeh-Won Lee 

Jeh-Won Lee is nearing the completion of his thesis. He is currently working for 
NASA Marshall Space Flight Center while he completes his degree. 

The numerical simulations of RALF (Robotic Arm Large and Flexible) were 
compared to results obtained from TREETOPS, a NASA sponsored code. Discrepancies 
found appear to be due to the means of enforcing the constraints for the TREETOPS code. 
Mr. Lee is working with TREETOPS in his job at Marshall, and so has an excellent 
opportunity to influence the direction of its development. 

Experiments with the large motion behavior of RALF are being examined for various 
geometrical nonlinearities, Coriolis and centrifugal forces influencing the behavior. 
Experimental results for nonlinear systems lack an accepted way to categorize the results. 
Mr. Lee is looking at sinmoidal motions and the resulting harmonics that appear in strain 
and joint measurements. 

Initial drafts of all chapters of Mr. Lee’s thesis have been received. He should 
complete his degree early in the Winter ’90 quarter. 

PUBLICATIONS 

Lee, Jeh-Won and Wayne J. Book, "Efficient Dynamic Models for Flexible Robots," 
submitted to 1990 IEEE Robotics and Automation Conference, May 13-18, 
Cincinnati, OH. 
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RESEARCH TOPIC: Control of a Small Working Robot on a Large Flexible Manipulator 

for Suppressing Vibrations 
RESEARCH ASSISTANT: Soo Han Lee 

The main research activities during this period were working for the construction of 
the I/O interface boards of the small robot, and studying for the development of the 
control algorithms for the small robot (SAM, Small Articulated Manipulator). 

1) Although a prototype I/O board designed by Douglas J. Paul, who earned his MS 
in March of this year, worked well for single joint operation, the board had reliability and 
noise problems. In order to solve these problems, printed circuit boards were constructed. 
In addition to the construction of the I/O boards, the kinematics, inverse kinematics, and 
dynamic equations of motion of the small robot were obtained for testing and calibrating 
the total robot system that consisted of a controller, I/O interface boards, and mechanical 
hardware. 

2) Inertial forces are generated by the movement of SAM around a nominal 
configuration. The nominal configuration is related to the direction of the inertial forces. 
The direction of the inertial forces affect the stability of the vibration control of the large 
arm on which SAM is mounted, RALF (Robotic Arm, Large and Flexible). The stability 
analysis has been done using lumped mass-spring analogy and force diagrams. This analysis 
shows that decoupling is achieved if the nominal angle of the lower joint of SAM should be 
90 degrees to the upper link of RALF, and the angle of the upper joint of SAM should be 
90 degrees to the lower link of RALF. Hence a control law has the terms which force SAM 
to keep these nominal angles. 

3) In order to suppress the vibrations of RALF, the angles of SAM should oscillate 
around the nominal angles and the oscillation should generate D or PD actions in response 
to the vibrations. The amplitudes of the oscillation need to be reasonably small for not 
disturbing the stability and nominal configuration of SAM. Total control forces must 
require less than the peak torque of a joint motor. Up to now the effects of D and PD 
control have been found; D control suppresses the vibrations at nearly same rate as PD 
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control, and needs less torque than PD control. PD control is more effective than D control 
in keeping nominal angles. 


PUBLICATIONS 

Book, W. J. and Soo-Han Lee, "Vibration Control of a Large Flexible Manipulator by a 
Small Robotic Arm," Proceedings. 1989 American Control Conference , Pittsburgh, 
PA, July ,pp. 

Lee, Soo-Han, Wayne J. Book, "Control of a Small Working Robot on a Large Flexible 
Manipulator for Suppressing Vibrations," Submitted to 1990 American Control 
Conference, May 23-25, 1990, San Diego, CA. 

Book, W. J., Soon-Han Lee, "Robot Vibration Control Using Inertial Damping Forces," 
submitted to 1990 CISM-IFTOMM Symposium on Theory and Practice of Robotic 
Manipulators, Cracow, Poland, July 2-6, 1990. 
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RESEARCH TOPIC: Control Strategy for Cooperating Disparate Manipulators 
RESEARCH ASSISTANT: Jae Young Lew 

Jae Lew’s research seeks higher performance manipulators in large workspace, 
particularly for those that require precise positioning and mating relatively massive 
payloads. Demand for these manipulators can be found in some of the common space 
maintenance and construction scenarios. As a solution, the concept of a small arm 
mounted on the end of a large arm is introduced to provide precise motion as well as large 
workspace. From a real world experience with crane-human coordination, when a heavy 
payload is unloaded, we know that we can obtain precise positioning and high payload 
capacity. This crane-human configuration may be analogous to the topology of bracing at 
the tip of the small arm and having an end effector at the middle of the chain. Since 
contact with the environment occurs at a bracing point on the small arm, similarity to a 
dual arm topology exists. However, this topology is different than dual arm in some ways. 
For example, the large arm (crane) is powerful and the small one (human) is capable of 
precise positioning. To take full advantage of such disparate features, several control 
strategies have been studied. 

The short term objective is to investigate and identify the theory and the related 
problem behind the disparate large /small arms coordination. The research activities 
during the last 6 months have included the following. First, related literatures were briefly 
reviewed. Second, the kinematic topology was synthesized in various combinations of the 
large/small arms for the planar motion. Third, the kinematics for the large/small arms was 
studied when they are constrained by a closed chair, and the advantage of the proposed 
configuration was analytically proven. Finally, with the master/slave approach, the control 
strategy for the two arms was considered, and the typical force control problem of a flexible 
arm, so called, "non-colocated control" was examined. 
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PUBLICATION 

Lew, Jae Y. "Control Strategy for Cooperating Disparate Manipulators", (Draft) Ph.D. 
thesis proposal, Department of Mechanical Engineering, Georgia Institute of 
Technology, Atlanta, Georgia, Fall Quarter 1989. 
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RESEARCH TOPIC: Dynamics of Cooperating Robots 
RESEARCH ASSISTANT: Jonathan M. Cameron 

SHORT TERM OBJECTIVE: Assist in various research-related activities and prepare for 

Ph.D. qualifying exams. 

Mr. Cameron worked as a graduate research assistant for one month of this reporting 
period. During that time, he assisted with several research-related activities in the ME 
Research building. Also, he helped in the system management of several computers 
related to this research. Much of his time was spent in preparing for his Ph.D. qualifying 
exams which he took in the beginning of November and passed. 

In relation to this research, he prepared to write a robot simulation program that will 
be useful in this research as well as a useful tool in the ME research building. He also 
investigated several research ideas in preparation to forming a dissertation proposal. 
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RESEARCH TOPIC: Control of a Large Flexible Arm 

RESEARCH ASSISTANT: Bau-San Yuan (previously supported) 

PUBLICATIONS: 

Yuan, B-S, J. D. Huggins, and W. J. Book, "Small Motion Experiments on a Large Flexible 
Arm with Strain Feedback," Proceedings. 1989 American Co ntrol Conference. June 
21-23, 1989, Pittsburgh, PA, pp 2091-2095. 

Yuan, B-S, W. J. Book and J. D. Huggins, "Decentralized Adaptive Control of a Two 
Degree of Freedom Flexible Arm," to be presented, 1989 ASME Winter Annual 
Meeting, December 10-15, 1989, San Francisco, CA. 

Yuan, B-S, Wayne J. Book and Bruno Siciliano, "Direct Adaptive Control of a One-Link 
Flexible Arm with Tracking," to appear J. of Robotic Systems. December 1989. 

Yuan, B-S, W. J. Book and J. D. Huggins, "Control of a Multi-Link Flexible Manipulator 
with a Decentralized Approach," submitted to the 11th IFAC World Confress, 13-17 
August, 1990, Tallinn, USSR. 
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RESEARCH TOPIC: Characterization of the Limits of Control of Flexible Arms 

RESEARCH ASSISTANT: Sabri Cetinkunt 

PUBLICATIONS: 

Cetinkunt, Sabri and Wayne Book, "Performance Limitations of Joint Variable Feedback 
Controllers Due to Manipulator Structural Flexibility," submitted to IEEE 
Transactions on Robotics and Automation . June, 1989. 

Cetinkunt, Sabri and Wayne J. Book, "Symbolic Modeling and Dynamic Simulation of 
Robotic Manipulators with Compliant Links and Joints," Robotics and Computer 
Integrated Manufacturing. Vol. 5, No. 4, pp. 301-310, 1989. 
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APPENDIX 

The abstract of the paper "A Causal Approach to The Inverse Dynamics of a Flexible Link 
Arm" was submitted to the 90’ American Control Conference. 

Book, W. J. and Soo-Han Lee, "Vibration Control of a Large Flexible Manipulator by a 
Small Robotic Arm," Proceedings. 1989 American Control Conference . Pittsburgh, 
PA, July 1989. 

Book, W. J., Soon-Han Lee, "Robot Vibration Control Using Inertial Damping Forces," 
submitted to 1990 CISM-IFTOMM Symposium on Theory and Practice of Robotic 
Manipulators, Cracow, Poland, July 2-6, 1990. 

Cetinkunt, Sabri and Wayne Book, "Performance Limitations of Joint Variable Feedback 
Controllers Due to Manipulator Structural Flexibility," submitted to IEEE 
Transactions on Robotics and Automation . June, 1989. 

Cetinkunt, Sabri and Wayne J. Book, "Symbolic Modeling and Dynamic Simulation of 
Robotic Manipulators with Compliant Links and Joints," Robotics and Computer 
Integrated Manufacturing. Vol. 5, No. 4, pp. 301-310, 1989. 

Lee, Jeh-Won and Wayne J. Book, "Efficient Dynamic Models for Flexible Robots," 
submitted to 1990 IEEE Robotics and Automation Conference, May 13-18, 
Cincinnati, OH. 

Lee, Soo-Han, Wayne J. Book, "Control of a Small Working Robot on a Large Flexible 
Manipulator for Suppressing Vibrations," Submitted to 1990 American Control 
Conference, May 23-25, 1990, San Diego, CA. 

Yuan, B-S, J. D. Huggins, and W. J. Book, "Small Motion Experiments on a Large Flexible 
Arm with Strain Feedback," Proceedings. 1989 American Control Conference . June 
21-23, 1989, Pittsburgh, PA, pp 2091-2095. 

Yuan, B-S, W. J. Book and J. D. Huggins, "Decentralized Adaptive Control of a Two 
Degree of Freedom Flexible Arm," to be presented, 1989 ASME Winter Annual 
Meeting, December 10-15, 1989, San Francisco, CA. 
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Yuan, B-S, Wayne J. Book and Bruno Siciliano, "Direct Adaptive Control of a One-Link 
Flexible Arm with Tracking," to appear J. of Robotic Systems, December 1989. 

Yuan, B-S, W. J. Book and J. D. Huggins, "Control of a Multi-Link Flexible Manipulator 
with a Decentralized Approach," submitted to the 11th IFAC World Confress, 13-17 
August, 1990, Tallinn, USSR. 


Submitted to 1990 American Control Conference, May 23-25, 1990, 
San Diego, Ca. 


A CAUSAL APPROACH TO THE INVERSE DYNAMICS OF A FLEXIBLE LINK ARM 

Dong-Soo Kwon and Wayne J. Book 
The George W. Woodruff School of Mechanical Engineering 
Georgia Institute of Technology 
Atlanta, Georgia 30332 

ABSTRACT 

An inverse dynamic equation which gives a causal solution for certain desired end 
point trajectories is derived from a flexible arm by using model. The model uses assumed 
modes to represent arm bending. The torque which is calculated from the inverse 
dynamics is applied to the arm as an open loop control. However, the friction at the joint 
and unmodelled dynamics causes tracking error and final positioning error. To 
compensate for these errors, feedback control is added to the nominal joint position and 
strain commands which are obtained from the forward dynamics model upon applying the 
torque calculated from the desired end point trajectory. The results of open loop control 
and the combination of open loop control and feedback control are shown in simulation 
and experiment. Also, preliminary results for control of a flexible link arm as it contacts a 
rigid surface to initiate a bracing action are presented. 


To appear in Procee din gs , 1 9 8 9 American Contro 
Conference, June 1989, Pittsburgh, PA. 


VIBRATION CONTROL OF A LARGE FLEXIBLE MANIPULATOR 
BY A SMALL ROBOTIC ARM 1 

Wayne J. Book and Soo Han Lee 

George W. Woodruff School of Mechanical Engineering 
Georgia Institute of Technology 


ABSTRACT 

The vibration of a large flexible 
manipulator is suppressed by inertial forces 
induced by the joint torques of a small arm 
which is located at the tip of the large 
manipulator. The control of the small arm 
is studied based on a slow and fast submodel 
which are derived by applying the singular 
perturbation technique. A composite 
controller is designed to control the slow 
and fast motion. 

I. Introduction 

A large, two degree of freedom flexible 
manipulator which has a small arm at one 
end has been constructed in the Flexible 
Automation Laboratory at Georgia Institute 
of Technology as shown in Figure 1, The 
large manipulator is designated RALF 
(Robotic Arm, Large and Flexible) and the 
small arm is designated SAM (Small 
Articulated Manipulator). The large 
flexible manipulator is for gross motions, 
and the small arm is for fine motions. The 
large manipulator consists of two ten foot 
long links made of aluminum tubing 
actuated hydraulically through a parallel 
link drive. The small arm is actuated by 
three brushless D.C. motors through 
harmonic drives at each joint. The small 
arm could be used as a fast wrist or braced 
robot. In this research, however, the small 


1 This work was partially supported by NEC 
Corporation and the Computer Integrated 
Manufacturing Systems Program at Georgia 
Tech. 


arm is used as an inertial force generator for 
suppressing flexible vibrations of the large 
manipulator. This is consistent with many 
applications where the small arm has little 
to do during large arm motion. 

To control the vibration of a light 
weight manipulator, most researchers have 
used the joint actuators of that manipulator. 
The joint actuator also controls rigid body 
motion. A few researchers have studied 
using additional actuators which control 
flexible motions. Zalucky, and Hardt [1] 
designed two parallel beams with a 
hydraulic actuator mounted at one end. 
This arrangement was used to compensate 
deflection and to improve dynamic 
response. A similar configuration was 
applied to tracking control [2]. Singh and 
Schy [3] studied control of the vibraton by 
external forces acting at one end. Their 
approach required separate actuators solely 
for vibration damping. 

When the RALF changes 
configuration, the vibration modes of the 
manipulator change. SAM also can change 
its configuration to increase the ability to 
suppress vibrations of RALF. 

In order to study the effectiveness of 
the inertial force of SAM, the dynamics of 
the manipulator is decomposed into a slow 
and a fast submodel by applying the singular 
perturbation technique [4]. A composite 
controller is designed based on the 
submodels. 

Two Time Scale Control 

The dynamics of a flexible manipulator 
is viewed as coupled rigid and flexible 
motion which, under certain conditions, can 



be also classified as slow and fast motion. 
In this case, the system dynamics can be 
analyzed by a two time scale model [4]. 
Several researchers have applied singular 
perturbation theory to the control of 
manipulators with flexible joints [5,6]. One 
of the authors has studied the control of 
flexible manipulators based on two time 
scale models [7,8]. In this study, the 
effectiveness of inertial forces of the small 
arm for suppression of vibrations is studied 
by two time scale model. 

For initial understanding the large 
flexible arm is considered with joints locked. 
The deflection of each link is modeled with 
one assumed mode. Based on analysis by 
Tsujisawa [9] this is adequate to represent 
the most important dynamic behavior. 
Applying Lagrange’s equations to this 
configuration the general form resulting is: 
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where, 

M(0,q) is the inertia matrix, 

N(0,0,q,q) contains nonlinear and 
gravity terms, 

K is the stiffness matrix, of RALF 
8 is the vector of joint angles of SAM 
q is the vector of deflection amplitudes 

and 

u is the control torque vector. 

This equation can be expressed as, 


8 « -H^Kq - + H u u 

( 2 ) 

q = -H^Kq - H 21 N, - + H 21 u 


where, [HL] is the inverse matrix of matrix 
M. 


By taking /x = 1/k,, as a perturbation 
parameter, we can rearrange equation (2) as 
follows; 
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H 12 N 2 + H 11 U (3a) 


tiz « -KH 22 z - KH^Nj - KH 22 N 2 + KH 21 u 

(3b) 

where, K - /iK, and z - kq. 

When we set M = 0, we can obtain the 
quasi-steady-state z as, 
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where the over-bars are used for denoting 
the terms when n = 0. By substituting (4) 
into (3-a), we can obtain the slow submodel, 
that is, the rigid model of a manipulator as, 

8 = + u) (5) 

To derive the fast submodel, we assume that 
the slow variables 0, are fixed during the fast 
transient. By introducing the fast time scale, 
we can obtain the fast submodel as, 


T - t/J/T 

h" - KH 22 r? + KH 21 u f (6) 


where, t? = z - z 
u f = u = u 

and " indicates diferentiation with respect to 

T. 

In order to guarantee that the fast 
variables z follow the slow manifold, we 
need to use a composite control law [4] as, 


u = u(0) + U f (77) 

In this research, a nonlinear feedback 
control law like the computed torque 
method is used for controlling the slow 
motion. A pole assignment control 
algorithm is used for the fast motion. If the 
number of actuators and modes included in 
modeling are the same enabling the 
neceesary matrix inverse, the slow control 
law, u, and the fast control law, u p are given 
as 


motions of the flexible arm, several other 
parameters must be considered, such as the 
nominal joint angles, initial conditions, and 
which mode is to be damped. 

While the fast control algorithm 
described above requires equal numbers of 
actuators and modes, this is not a general 
limitation for other possible algorithms. 

Further work on these issues is 
underway. 

REFERENCES 


u * N 
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where, A a , A 2 and A 3 are diagonal gain 
matrices and the subscript s denotes the 
slow motion control, and f denotes the fast 
motion. 


II. DISCUSSION 

The application of the two time scale 
control has verified the simplification 
possible with this approach. The two 
control laws must each control a 4th order 
system as opposed to one 8th order system. 
This will make real time implementation 
easier. 

The advantage of simplification is 
obtained at the price of limited 
performance. The fast system variables rj 
are controlled relative to the slow manifold 
Z. Thus when tj= 0 the deflections q might 
not be zero. 

Based on preliminary studies of a one 
link flexible arm with a one link rigid arm 
on its tip, we expect effective vibration 
dampening. When compared to joint 
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Figure 1: The system of interest: RALF 
(Robotic Arm, Large and Flexible) carrying 
SAM (Small Articulated Manipulator). 


Submitted to 1990 CISMOTFT.MM Symposium on Theory and Practice of 
Robotics and Manipulators, Cracow, Poland, July 2-6, 1990. 


Robot Vibration Control Using Inertial 

Damping Forces 


Wayne J. Book 
Soo-Han Lee 

School of Mechanical Engineering 
Georgia Institute of Technology 
Atlanta, GA 30332, U.S.A. 
Tel. 404-894-3247 


Lightweight manipulators are subject to vibrations that reduce their 
performance. Active means to damp these vibrations are of significant 
research interest. Joint actuators of the arm can perform this task very 
effectively as has been shown in theory and experiment by several researchers. 
These actuators must respond at the bandwidth of the vibration they are to 
damp. If the manipulator and/or the payload is large the actuators are 
correspondingly large. The bandwidth requirement is a serious impediment to 
practical implementation of the active vibration damping scheme. An 
alternative under exploration is vibration damping through inertial forces. 
Inertial forces are commonly used for active vibration control in large space 
structures. Reaction wheels and linear momentum exchange devices are placed 
on the structure specifically for this purpose. This paper will explore the 
use of the existing degrees of freedom at the end of a large arm to damp 
vibrations during gross motions when they are not otherwise employed. These 
smaller actuators can have a higher bandwidth and more precise control than 
the joints used to reconfigure the arm. The smaller actuators could be 
actuating the wrist of a manipulator in a traditional industrial manipulator. 

The system used in the analysis and experiments of this paper is actually two 
arms. (See Figure 1.) The large arm is designated RALF (Robotic Arm Large 
and Flexible). It consists of two, 3 meter beams and two rotary joints 
actuated by hydraulic cylinders and controlled by a MicroVAX II computer. The 
moving structure weighs only 32 kg (70 pounds) and has natural frequencies 
under 9 Hz when no payload is present. A small arm with three electrically 
actuated degrees of freedom has two links of about .5 meter each. Each joint 
is controlled by a Motorola 68000 microprocessor supervise by a common IBM PC. 
It is designated SAM (Small Articulated Manipulator). Its links are 
essentially rigid. SAM is designed to be carried by RALF. These robots are 
test beds for control algorithms and operating strategies appropriate to 
flexible arms. In this paper we consider the use of SAM to generate inertial 
forces for damping the vibrations of RALF. Motions in a plane are our initial 
consideration. 

The effectiveness of the inertial forces in damping vibrations depend on the 
nominal configuration of both arms. At this time we are not considering the 
problem of moving the small arm to the configuration that will be required for 
the manipulator task. As a useful strategy the center of mass of the small 
arm and its motion are moved as required for inertial force generation on the 
tip of the large arm. The moments produced are of less significance on the 
motion of the large arm. The large arm is modeled by an assumed modes method. 



This model can be linearized when the motions- are relatively slow. The mode 
shapes of the arm change when the arm changes configuration, and this is 
accounted for in determining the appropriate small arm nominal configuration 
ang the appropriate small arm nominal configuration 
and motions. 

SAN is significantly affected by the nonlinear terms in the dynamics. Its 
controller must allow for these terms. The control explored strives to 
maintain the simplicity of a decoupled motion. In other words, the large and 
small arm are controlled separately, not as a single kinematic chain. 

Conclusions on the most effective configurations for SAM for various 
configurations of RAIF are presented. The effectiveness inertial forces in 
active damping is compared to the use of the large arm's joints for active 
damping. Inertial forces do not appear to be as effective as joint motion for 
the test system. The approach is relevant to cases where the joint control is 
not possible, however. The approach seems particularly relevant to space 
manipulators proposed for the space station, where a small manipulator is 
carried by a "space crane." It also holds advantages for use in combination 
with a bracing strategy, since after bracing the small arm can be moved to 
perform its manipulation task without significantly exciting the large arm's 
vibration. 



FIGURE 1. The Test Case: Robotic Arm Large and Flexible (RALF) and Small 
Articulated Manipulator (SAM).‘ 
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Abstract 

The performance limitations of manipulators under joint variable feedback control 
are studied as function of the mechanical flexibility inherent in the manipulator struc- 
ture. A finite dimensional time domain dynamic model of a two link, two joint planar 
manipulator is used in the study. Emphasis is placed on determining the Limitations 
of control algorithms that use only joint variable feedback information in calculations of 
control decision, since most motion control systems in practice are of this kind. Both 
fine and gross motion cases are studied. Fine motion results agree well with previously 
reported results in the literature, and are also helpful in explaining the performance 
limitations in fast gross motions. 
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Nomenclature 

: elastic deformation of link i, at location x,* and time f. 

: vector of joint angles ([0i, 0 2 ]) 

: vector of flexible mode generalized coordinates 

: vector of effective torque at joints 

: [il 

: plant full state vector 

reference model state vector { [0,0 }de 3 ired ) 

: 

: commanded input vector to the reference model 

: error state vector ( x ^ - x# ) 

: filtered error state 

: output vector of the nonlinear time varying feedback block of the standard 

hyperstability problem 

: ij component of joint angle feedback gain matrix 

: ij component joint velocity feedback gain matrix 

: nominal joint variable (position and velocity) feedback gain matrix 

: nominal feedforward gain matrix 

: adaptive state feedback gain matrix 

: adaptive feedforward gain matrix 

: positive scalar constants of integral gain adaptation algorithm. 

: the lowest natural frequency of the arm with all joints clamped. 

: closed loop bandwidth of the feedback controlled flexible arm 

: closed loop bandwidth of the feedback controlled equivalent rigid arm 

: desired motion bandwidth (the natural frequency of the reference model which 

has step command input) 

: damping ratio of mode i 

: n dimensional real vector space 
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6 : belongs to symbol 

3 : there exists symbol 

{ P} : dynamic systems defined by Popov class 

— *■ : approaches symbol 

LTI : linear time invariant 

NLTV : nonlinear time varying 

FFB : feedforward block 

FBB : feedback block 

AMFC : adaptive model following control 

CLS : closed loop system 
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I. Introduction 

Robotic manipulators have compliance that are inherent in their links and joints. 
The compliance becomes significant especially at high manipulation speeds and/or large 
payload conditions. Today, there is an increasing demand for manipulators with high 
speed, precision and payload handling capabilities as a result of higher productivity 
needs. Hence, the manipulator flexibility and control of it has become an important 
problem. In some cases, structural flexibility in manipulators may be desirable. For 
instance, a manipulator cleaning delicate surfaces, handling household jobs, is desired to 
have significant structural flexibility so that errors in position control do not generate 
large forces that may damage the surface, or become dangerous for the people in the 
house in case of accidents. 

Regardless of the reason that the flexibility becomes significant (i.e. due to high 
speeds, large payloads, inherently very soft links for household services), precision con- 
trol of the manipulator tip is necessary to accomplish the desired task. Manipulator 
motions may be divided into two groups in terms of the range of motion: 1. fine mo- 

tion, 2. gross motion. In fine motion, the manipulator tip moves in a small region 
of workspace. Despite high closed loop bandwidth, absolute velocities do not become 
very large since the motion occurs in a small region. Therefore, the nonlinear dynamic 
forces (coriolis and centrifugal) are generally negligible. In gross motion, the manipu- 
lator tip makes large rotational maneuvers in workspace. The large rotations of joints 
relative to each other are the main source of complicated nonlinear dynamic coupling 
between the generalized coordinates [Shabana and Wehage 83, Sunada and Dubowsky 
82]. Absolute velocities may become large during the fast, large maneuvers to the point 
that the nonlinear dynamic forces become very dominant [Luh 83]. 
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LI Review of the State of Art 

The majority of work in control of robotic manipulators ignores the flexibility of 
the manipulator in the analysis. Therefore, no reference is made to the effect and/or 
limitations of flexibility in control system performance [Dubowsky and DesForges 78, 
Balestrino et. al. 87, Hsia 86, Craig et. al. 86, Slotine 87]. In order to avoid the flexibility 
problem, very conservative controller design rules are suggested [Paul 83, Luh 83]. At a 
time when researchers are striving to design high performance controllers, it is logical to 
explicitly study the limitations imposed by the manipulator flexibility, instead of taking 
conservative design measures. Closed loop bandwidth limitations of non-adaptive joint 
variable feedback controllers were studied explicitly as function of arm flexibility in fine 
motion [Book et. al. 75]. However, the results can not be generalized to fast gross 
motions where dynamic nonlinear effects become significant. The dynamics of flexible 
manipulators are described by infinite dimensional mathematical models due to their 
distributed flexibility [Book 84, Low and Vidyasagar 87], yet the controllers are designed 
based on truncated finite dimensional models. The discrepancy between the designed 
performance and the actual performance achieved as a result of model truncation for the 
purpose of controller design is studied and an iterative design procedure is suggested in 
[Book and Majette 85]. 

The class of control algorithms studied here, that is algorithms that use only joint 
variable measurements, are particularly important since most industrial robots and mech- 
anisms are controlled that way. Tip position measurements [Cannon and Schmitz 84, 
Shung and Vidyasagar 87], strain measurements along the flexible link [Hastings and 
Book 86], tip acceleration measurements [Kotnic, Yuckovitch, Ozgiiner 88] are examples 
of attempts to design so called noncolocated controllers that would achieve performance 
beyond the traditional limitations of colocated controllers. A major problem associated 
with noncolocated control is the destabilizing effect of observation and control spillover 
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[Gevarter 69, Balas 78]. Independent joint variable control of multi-link manipulators, 
that is each joint control action is based on the local measurement information of that 
joint only (colocated control), does not have this problem since spillover never drives the 
system unstable in colocated control [Gevarter 69]. This conclusion, however, cannot 
be extended to the class of joint variable controllers where intra-joint feedback is used 
to achieve decoupled joint response [Book et. al. 75]. 

In short, joint variable feedback controllers require fewer sensors, have better stabil- 
ity robustness against spillover and unmodelled dynamics, and widely used in practice. 
Therefore, it is worthwhile to study their potential use in fine and gross motion control 
of flexible manipulators, even though their upper limit of closed loop bandwidth is in 
general considerably smaller than that of noncolocated controllers. In particular, the 
adaptive joint variable feedback controllers should be analyzed since they receive increas- 
ing interest due to the adaptability of feedback gains as a function of the changing task 
conditions. 

1.2 Characterization of the Problem and Definitions 

The signficance of structural flexibility in motion control of a manipulator is a func- 
tion of the task conditions. Any given manipulator can be moved slowly enough that 
the structural flexibility will not cause any significant deviation from the intended mo- 
tion. Similarly, it can also be moved fast enough such that the structural flexibility will 
become very apparent in the response of the manipulator (presuming the availability of 
actuators that can deliver sufficiently high torque/force levels). 

Physically, every robotic manipulator has structural flexibility. The question of 
whether the controller needs to be concerned with it or not varies from task to task. 
At this point, one must quantify the term slow enough motions such that flexibility 
does not present any problem, as well as the fast enough motions where the flexibility 
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does present a problem. 

The speed of motion is quantified as slow or fast (low, medium, or high speed) with 
respect to the structural flexibility of a manipulator using the lowest structural frequency 
of the manipulator when all joints are locked ( ) as the reference. 

[Book et. al. 75] quantified the speed of a given fine motion relative to the struc- 
tural flexibility using the ratio of necessary closed loop bandwidth (w biu ) to the lowest 
structural frequency of the system ( w iw /u >* t ). Given a manipulator, and a desired fine 
motion, one can easily predict whether the structural flexibility will be significant or not 
during that motion using the ratio of (w bw /w st ). 

In fast gross motion, where dynamic nonlinearities are dominant due to high joint 
speeds and large angular rotations, the notion of bandwidth is no longer a well defined 
characteristic of the control system. However, in the context of model reference control, 
the speed of gross motion may be quantified using the bandwidth of the reference model, 
(u'n»)» with a step input. Here, the ( w m /w , t ) ratio is proposed to quantify the speed of 
gross motions relative to the structural flexibility. 

The essential difference between this work and other works in control of single link 
flexible arm is that, in case of multiple joints (two joint two link example used in this 
study) there are many nonlinear couplings between the generalized coordinates of dif- 
ferent links as a result of large angular rotations of joints. Most of these couplings do 
not exist in single link case. [Book et. al. 75, Book and Majette 85] studied the control 
aspects of two link two joint flexible manipulator example in fine motion using infinite 
dimensional linear frequency domain models based on transfer matrices. Here both fine 
and gross motion control aspects are studied using a finite dimensional nonlinear time 
domain model. 

The remainder of this paper is organized as follows: The mathematical model of 
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a two-link, two joint flexible manipulator is briefly described in Section II. Fine and 
gross motion control under joint variable feedback controllers are analyzed in Section 
III, results are discussed in Section IV. The conclusions of this work are summarized 
in Section V. Design details of the proposed adaptive model following controller are 
presented in the Appendix. 

II. Dynamic Model of a Two Link Flexible Manipulator 

Symbolic derivation details of dynamic models for flexible manipulators are described 
in [Cetinkunt and Book 89]. The differences between different Lagrangian-assumed 
modes based modeling approaches come from the kinematic descriptions. Here the 
kinematic description will be summarized, and derivation using Lagrangian-assumed 
modes approach will be skipped since it is a well known standard procedure. 

Let (0 0 X 0 Y 0 ) be the inertial coordinate frame (Fig. 1). Assign two coordinates 
for each flexible link; one is fixed to the base (e.g. Oi Xi Vi), the other is fixed to the tip 
of the link (e.g. 0 2 X[ Y{). In order to describe the absolute position of any differential 
element on the links, let 0, and 0 2 describe the joint angles, and w^rj, t), w 2 (x 2 , t) 
describe the elastic deformations of links from the undeformed positions. 

The spatial variable dependence of the deformation coordinates leads to a math- 
ematical dynamic model that is of partial integro-differential equation form [Low and 
Vidyasagar 87]. In order to simplify the model, the deformation coordinates are approx- 
imated by a finite series which consists of shape functions multiplied by time dependent 
generalized coordinates. 

n, 

w,(x t -, t) = ; 1 = 1,2 

1=1 

j = 1 , . . . , n, 

where m is the number of mode shapes considered in the approximation in describing 
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the elastic deformation of link i. 

This results in a finite order dynamic model. Since the spatial variable dependence 
is already specified through the shape functions, the mathematical model is of ordinary 
differential equation form. Let us order the generalized coordinates as q = [0, 6], where 
$ = [ 0 i,<? 2 ]) the joint coordinates, and 0 = [( 0n, • . . , 0in,)],( 02 i, • • • ,02 n,)]) the deformation 
coordinates. Having uniquely established the kinematic description of the manipulator, 
the derivation steps of the equations of motion via Lagrangian formulation is straight for- 
ward [Book 84, Cetinkunt and Book 89]. The dynamic model of a flexible manipulator 
may be expressed in the form 


m r ( 0, 0) m r f( 0, 0) 

0 

_L 

\L\ 

+ 

0 


. m r/( 0> 0) m /(0-0). 

_0_ 

1 

Uj\ 

i 

_[K]S 

l£/J L . 


where m r (0, 0), m rf ( 9 , 0), m f ( 9 , 0) are partitioned elements of generalized inertia matrix 
which is always positive definite, and symmetric, £.(0,0, 0, 0), £(0, 0. 0, 0) coriolis 
and centrifugal terms which are quadratic in the generalized coordinate velocities (0, 0); 
g ( 9 , 0), 9 j{ 9 , 0) are gravitational terms; and [If] is the structural stiffness matrix associ- 
ated with arm flexibility and mode shape functions, u represents the effective torque (or 
force) vector at the joints. For the two link arm example considered here 0 = [0i, 02], 
and since two mode shapes are used per link, 0 = [(0u, 012 ), ( 02 i, <522)]- 

The equation (2.1) is a highly nonlinear and coupled ordinary differential equation 
set. This makes the controller synthesis and design a problem difficult. Furthermore, 
experiments [Hastings and Book 86] and analytical studies [Cetinkunt and Yu 89] indi- 
cates that the mode shapes of the links quickly converge to the mode shapes of clamped- 
base beam under joint variable feedback control for even low values of feedback gains of 
interest. All mode shapes of a clamped-base beam have zero slope at the base, there- 
fore B m = 0 for the dynamics of flexible manipulators under feedback control. That 
means the joint variable controller effects the flexible variables through coupling from 
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joint variables, but not directly through the input matrix. The dynamic model of a 
rigid manipulator, in general, has the form 

[M(0)]£+/(0, 0 ) + £(0) =« (2-2) 

The structural difference between the dynamics of rigid and flexible manipulator is dis- 
played by equations (2.1) and (2.2). 

III. Fine and Gross Motion Control with Joint Variable Feedback 

The question of when the arm flexibility becomes significant and what limitations it 
imposes on the performance of joint variable controllers are studied first in fine motion. 
The results are valid only when the dynamic nonlinearities are negligible. In order to 
determine the effect of dynamic nonlinearities, the linear and nonlinear control algorithms 
are simulated on the nonlinear model (2.1). 


III.l Fine Motion Control 

The nonlinear model (2.1) is linearized about a nominal configuration, i„ = 
[£> £, £, 5] = [ inominai . 2, 2. 2] nominal input u nomin ai which compensates for the nom- 
inal gravitational loading. Since nonlinear coriolis and centrifugal terms are quadratic 
j n they have no contribution to the model that is obtained by linearizing about 
a nominal configuration where nominal values of velocities are zero (£ = £ = 2)- Let 
£ = ^nominal + A£, 6 = S^ ominal + A £, and u = + Am, then the linear dynamic 

model about the nominal configuration = [tnominah 2. 2, 2] is given by (3.1), 


m r m r f ( A£) 
m r y my \ A 6 j 

s 

M.n 


+ 


'dg 186 dg/d6 1 f A£) _ f Au\ 
dgj/de dg_ f /dS + [K ]j \A£J - \ Q / 


K.n 


(3.1) 


In compact form, let A * = [ A £, A £, A £, A 6], the linear dynamic model about the given 
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nominal configuration can be expressed as, 

A i = A A x + BAu 


(3-2) 


where 


A = 


-M " 1 


0 

«//*•// 



(3-3) 


The closed loop eigenstructure of the linear model under linear joint variable feedback 
controllers is studied as a function the feedback gains. The Unear joint variable feedback 
control has the general form 


A u= -[tfolAfl- [C o ]A0 


(3-4) 


For independent joint control; 

[Kij] — diag{ka} 

[Cij] ~ diag{cu} 

For decoupled joint control; 

— r/l nominal i 

[Cq'] — XTl r ( ^nominal > 0) diag{ca j 

Independent joint control results are presented here in order to compare with the previ- 
ously reported ones. Position and velocity feedback gains of joint 1 , (fcn> cu)i are se t 
to very high values in order to force the joint 1 behave like a clamped base. The locus 
of closed loop eigenvalues are studied as a function of joint 2 feedback gains, &22, c 22 ■ 
The finite dimensional linear model should be able to predict at least the dominant be- 
havior of the closed loop dynamics of the infinite dimensional actual system, despite the 
errors introduced due to truncated dynamics. Otherwise the truncated finite dimen- 
sional model would not be of any value. 

By comparing the root locus behavior of a given flexible manipulator with that of 
an equivalent rigid manipulator, the conditions at which flexibility becomes significant 


8 



Cctinkunt & Book 89 


and the range of conditions where the flexibility can be ignored can be determined 
and compared with reported results. The study of dominant behavior of closed loop 
eigenvalues will determine the best possible performance in fine motion. 

HI. 2 Gross Motion - Adaptive Model Following Control 

The fundamental challenge in the control of industrial and space robots is to provide 
high speed, high precision motions despite large variations in payload, and other task 
conditions. Extensive research in the past decade has shown that adaptive control 
methods are potentially more promising to meet that change than non-adaptive control 
methods. It is desirable to have an adaptive controller that would achieve the following 
performance criteria: 

1. Good transient and steady state tracking of desired motion trajectory. 

2. High speed and precision manipulation in gross and fine motion (high closed loop 
bandwidth) relative to the structural flexibility. 

3. Good performance and stability robustness against unknown task condition varia- 
tions. 

An adaptive model following control (AMFC) algorithm is developed based on the 
hyperstablity approach [Cetinkunt 87]. The design details are presented in the Ap- 
pendix in order to keep the essential points of this paper in focus. Let us call xj = [£, 0], 
The adaptive control algorithm is given by, (Fig. 2) 

u — —K pn x_g + K un u m + A/< p ( e, t) + AA U ( e, t) (3-5) 

where 

K pn = m r (6, <5, t )[[M> [ c «l] (3. 6. a) 

K un = m r (9, 6, t ) (3.6.6) 

AA'p = [ p pi m r (6 0 , 6 st )vxl dr (3.6.c) 
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AK U = f Puim r (9 0 ,6 a ,)v^,dT (Z.6.d) 

J 0 

[*«], and [c ti ] are the reference model dynamic components chosen by the designer, 
is the static deflection values of flexible modes. Here, the reference model is chosen as 
a decoupled linear system of the form 


[in' 


Q 

I 

V 

+ 

Y 

UmJ 


. [ 


[tn\ 


i 


The response of the reference model, ^(t), to the commanded input, u m (t), is the desired 
joint response. The reference model dynamics affects the control through equations 
(3.6.a, c, d). Using in the control algorithm does not require real-time feedback 
information about the flexible states. Therefore, the controller is still a joint variable 
feedback control algorithm. The use of as opposed to 0 (zero) for the flexible modes 
is more accurate and improves the decoupled control of the flexible manipulator without 
imposing any significant implementation difficulty. The v_ is the filtered tracking error e 
(Fig. 2). p P i and p u , are arbitrary positive scalar adaptive controller design parameters 
effecting the convergence rate of the adaptive control system and the transient response 
of the closed loop system. 

The specific dynamic characteristics of manipulators are utilized in the general con- 
text of hyperstability based design so that the resultant controller is particularly suitable 
in control of manipulators exploiting their specific dynamic characteristics as opposed to 
treating them as a black box dynamic system. Following that philosophy, the general- 
ized inertia matrix plays a significant role in the adaptation algorithm (eqn. 3.6.c-d), and 
in the nominal control (eqn. 3.6.a-d). First, the feedback gains are naturally adapted in 
a manner to preserve the decoupled joint control. Secondly, arbitrary parameter selec- 
tion that is generally required in Lyapunov and hyperstability based designs, is reduced 
to the selection of only two scalar parameters no matter how many joints the manipulator 
has, as opposed to the usual requirement for selection of two arbitrary positive definite 
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matrices [Hsia 87]. Notice that the gain adaptation is of integral type (eqn. 3.6.c-d), 
which is a commonly used adaptation type in model reference adaptive control. 

IV. Results and Discussion 

IV. 1 Fine Motion Control Results and Discussion 

Let w* t be the lowest structural frequency of the manipulator when both joints 
are clamped and extended ( k n and k 22 — ► oo, cn and c 2 2 = 0, Fig. 3). Consider 
an equivalent rigid manipulator with the same inertial and geometric properties of the 
flexible manipulator. The rigid system with first joint clamped (k n — ► 00 ) will be a 
second order mass-spring system with feedback gains (^ 22,^22 ^ 0). Let uvi be the 
undamped natural frequency of the rigid system for a set of feedback gains k 22 and c 22 - 

In fine motion, the w ri /w* t ratio determines the significance of flexibility and the 
dominant behavior of the closed loop system. In the rigid manipulator case, it is pos- 
sible to achieve arbitrarily large closed loop bandwidth by increasing k 22 and c 22 , for 
ttVi = ^ 22 /(^ 02 ) e// , and damping ratio £ rl = c 22 /( 2.0 x ^/( ^o 2 ) e// * * 22 ), where ( J 0 2 ) e// 
is the effective moment of inertia of link 2 and payload about joint 2 axis of rotation. 

However, when the same controller is applied to the flexibile manipulator, the closed 
loop bandwidth, Wb w will definitely be smaller than w * t , for the fact that as jb 22 — ► oo, 

| Wb w I — ► with very little damping ratio (Fig. 3). If the servo stiffness is low relative 

to the structural flexibility, that is w r i/w* $t < 1/2, the locus of closed loop eigenvalues 
is indistinguishable from those of rigid case as c 22 increases. However, if the velocity 
feedback gain, c 22 , is further increased to large values, the effective result is to stiffen 
the joint. One dominant eigenvalue meets with another on the negative real axis, and 
breaks away from the real axis converging to the u;*, magnitude on the imaginary axis 
as c 22 increases (Fig. 3, curve a, Fig. 4. a). In the rigid case, this phenomenon does 
not exist for any value of feedback gains. The root locus analysis of fine motion is 
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done as function of c 2 2 for many other values of w r \/w J,. The basic outcome of this 
analysis is illustrated in (Fig. 3 and 4, only dominant regions of root locus are shown in 
the figures). It is seen from (Fig. 4.b-c) that above certain values of i»,iK ratio, the 
dominant eigenvalues are no longer able to reach the real axis. Physically that means, 
if joint position control is too stiff relative to the arm flexibility, it is not possible to 
provide well damped dominant modes no matter how large the velocity feedback gain is. 

For a given manipulator and payload, u>' at is determined by the geometric, inertial 
and structural flexibility properties of the manipulator. If a joint variable controller 
attempts closed loop bandwidth larger than (l/2)u>; ( , then the flexibility of the manip- 
ulator will be a significant factor during the fine motions. Otherwise, the structural 
flexibility may be ignored, and controller may be designed based on rigid manipulator 
assumptions (Fig. 3, curve a, Fig. 4.a). The best performance of a joint variable feed- 
back controller is defined here as the highest possible closed loop bandwidth (that is 
the largest dominant eigenvalue magnitudes with sufficient damping ratios; i.e. 0.707 or 
more). As shown in figure 4.b, approximately (2/3) w’ t closed loop bandwidth can be 
achieved by appropriate choice of feedback gains. It is equally important, however, to 
note that the dominant eigenvalues axe very sensitive to the variations in feedback gains 
in the best performance region (Fig. 4.b, locations 8,9,10, between each point the velocity 
feedback gain is incremented by a constant amount). In practice it may not be easy to 
realize that performance due to modeling errors. 

The results concerning the effects of structural flexibility in closed loop performance 
agree very well with the previously reported results based on infinite dimensional fre- 
quency domain results [Book et. al. 75, Book and Majette 85]. 
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IV. 2 Gross Motion Control Results and Discussion 

In order to see the effect of dynamic nonlinearities, the closed loop system is sim- 
ulated for two classes of motions: first, slow motions where nonlinear forces are small 

(Fig. 5a- b, curves (a)), and secondly, fast motions where nonlinear forces are signifi- 
cantly larger or of same magnitude with the other dynamic forces (Fig. 5a-b, curves 

00). 

Fig. 6 shows the response of the manipulator with adaptive controller to the desired 
slow motion. Two different adaptive control results are shown for slow and fast adap- 
tion, refering to small and large values of the adaption parameters p p > and p UI . The 
appropriate values for these parameters are found by trial and error. This motion has 
two properties: 1. dynamic nonlinearities are not significantly large (Fig. 5, curve (a)), 

2. the bandwidth of the desired motion is about 1/4 of the lowest natural frequency 
of the arm. The bandwidth of the desired motion, w mi , is defined as the bandwidth 
of the reference model which generates the desired motion in response to a step input 
command (Fig. 2). 

Since the adaptive controller essentially tries to make the closed loop dynamic be- 
havior match to that of the reference model, the function of w mi in the nonlinear analysis 
content is similar to the function of the uvi in the linear analysis. Clearly, figures 6.a-e 
show that flexibility of the arm is not significant in terms of joint tracking and setting time 
of flexible vibrations at the end of motion, which is in agreement with the linear analysis 
results. When the same system is simulated for motion (b) where w mi /w ccl = 1/2 and 
nonlinearities are significant (Fig. 5a-b, curves (b)), the response deteriorates. Persis- 
tent, lightly damped oscillations occur in joint and flexible mode variables (Fig. 7.a-e). 
The difference between the two simulations (Fig. 6 and 7) is the magnitude of nonlinear 
forces (Fig. 5, curve (a) and (b)). When the nonlinear forces are significant compared 
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to other dynamic forces, the performance is unacceptably poor. Therefore, the nonlin- 
ear effects during fast gross motions impose further restrictions on the performance of 
adaptive joint variable feedback controllers with integral gain adaptation. 

The mechanism through which the nonlinear forces affects the joint controller per- 
formance can be desribed as follows with the help of the insights gained from the fine 
motion analysis. If the nonlinearities are significant, the adaptive controller automati- 
cally adjusts its feedback gains through integral adaptation (eqn. 4.6.c-d) to compensate 
for the tracking errors caused by the nonlinear forces. Increasing the controller gains 
through the adaptation rule eventually leads to very stiff joints. Linear analysis has 
shown that very high joint stiffness relative to the flexibility of a given arm results in 
very lightly damped dominant modes (Fig.3 curve (c), Fig.4.c). Thus, lightly damped 
dominant modes are generated by the adaptive controller, while it is trying to compen- 
sate for the joint tracking errors caused by the large nonlinear forces. It is important 
to note that this mechanism is valid for the class of adaptive controllers that use integral 
type gain adaptation. 
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V. Conclusion 

In fine and slow gross motions where coriolis and centrifugal nonlinear forces are 
negligible, a given manipulator can be considered as rigid if the controller does not 
attempt to reach closed loop bandwidth more than 1/2 of the lowest structural frequency 
of the manipulator when all joints are locked ( w * t ). In fine motion, the best possible 
performance of joint variable feedback controllers may be up to 2/3 of w st with damping 
ratios greater than 0.707. However, it is equally important to note that the sensitivity 
of the dominant eigenvalues to the variations of joint feedback gains are highest in the 
best performance region (Fig. 4.b, locations 8,9,10). Therefore, it may be difficult to 
achieve (2/3)u.’* 4 closed loop bandwidth in a practical situation due to the modeling 
errors. The fine motion analysis results obtained here based on a finite dimensional 
time domain model agree very well with the previously reported results based on infinite 
dimensional frequency domain models [Book et al. 75, Book and Majette 85]. 

The performance of an adaptive controller with integral gain adaptation is also shown 
to be limited by the structural flexibility. While the adaptation algorithm increases the 
feedback gains to provide good tracking in joint variables against the large nonlinear 
forces (Fig. 5, curve b), the same increase in feedback gains will result in very stiff 
joint hence persistent structural vibrations. Through that mechanism, the manipulator 
flexibility presents a potential problem and limitations to the utilization of adaptive 
controllers with integral type gain adaptation. 
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Appendix 

A.l AMFC-Hyperstability Based Design 

The basic idea of AMFC comes from the linear perfect model following control 
(LPMFC) problem of [Erzberger 69]. AMFC attempts to asymptotically realize the 
same objective of LPMFC for time varing systems. 

Let the reference model be 

X m = A m Zm + B m U m C' 4 ' 1 ) 

and the plant dynamics be in time varing (quasi- linear) form 

x„ = Ap(x p ,t)x p + B p (x p ,<)tx p (A.2) 

with the control algorithm of the form, 

Up — — K p X p + d" (.A .3) 

Clearly, as the plant dynamics (A p (xp, t), B p ( , t)) varies, the feedback gains must also 
vary in order to match the dynamics of the plant to that of the reference model. 

There are two basic assumptions associated with the current AMFC designs [Landau 
1979]: 

1. There exist K p , K u , K m for every (A p (^, t), , t)) and the given ( A m , B m ) 

so that at any instant LPMFC conditions of Erzberger are satisfied. 

2. Variations of A p ( x p , t), B P { s? , 0 are slower than the speed of adaptation. 

Assumption # 1 is an expected existence condition. AMFC attempts to converge 
to the ideally correct values of feedback gains through adaptation as the plant dynamics 
vary. Existence of such limit values is the first requirement for the convergence, let 
alone whether the adaptation algorithm will converge or not. 

Assumption # 2 is commonly made in most AMFC design methods. During adap- 
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tation intervals, it is assumed that time invariant approximations of plant model is 
accurate enough. Therefore, robot motions must be slow compared to the adaptation 
speed of adaptive controller. Let us look at the origin of this assumption by going 
through the derivation steps of hyperstability based AMFC design. 


Letting K m 
by 


= 0, without loss of generality [Landau 79], the error dynamics is described 


<L — A m §. + [ A m Ap( Xp, t) + Bp( Xp, t) Kp] Xp 
+ [ B m — Bp( Xp, t ) K u \ u m 


(A A) 


For e( t) — 0 as t — • oo for all x p , u m that belong to a piecewise continuous, bounded 
class of functions, the coefficients of x p , t±m must be zero. By assumption # 1, there 
exist K", K‘ such that 

Ap(Xp,t)-A m = Bp(x p ,t)K; (A. 5.a) 

B m = Bp(x p ,t)K: (A.5.b) 


The goal is to develop adaptive control algorithms for K p , K u such that K p , K u converge 
to Kp, K*. Convergence must be fast enough for the assumption # 2 to hold. 

Let the feedback gains be 

Kp = K pn - AK p (e, t) (A6.a) 


K u = K un +AK u (e,t) ( AS.b ) 

where K pn , K un are nominal, and AK P , A K u are adaptive feedback gain matrices. Fol- 
lowing the standard steps of hyperstability based design [Landau 79], it can be shown 
that the equivalent hyperstable closed loop system representation of the error dynamics 
can be expressed as (Fig. A.l) 

e = A m e + B p (Xp,t)i l {A.l. a) 

v = De (A.l.b) 
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z = -z, = [ K; - K pn + A K p ] x p + [K un + A K u - K’]u m (A.l.c) 


where D is determined by using Kalman- Yakubovich-Popov lemma. In order to guar- 
entee the hyperstability of the closed loop system (CLS), the A K p , A K u selection as 
follows is sufficient (not necessary): 

A K p {e,t)= f fa(v,t,T)dr + fa(v,t) + A.K p (0) (A. 8. a) 

Jo 

A K u {e,t) = [ tpi (v, t, r)dr + tp 2 (v, t) + AK u (0) {A.8.b) 

Jo 


where the most general conditions on <j>\, fa, 4>i, fa are discussed in [Landau 79], and 
more specific forms are discussed in section A.2. AK p (0), AK„(0) can be chosen as 

zeros without loss of generality since any nonzero values of them can be included in K pn , 
K un nominal gains. Substituting (A.8) into (A.7.c) 


z = -r t =[ f <t> i(v, t, r)dr + fa(v, t) + AA°]x p 
J o 

+ [f fa(lL,t, r)dr + fa( v, t) + AA°] u. 

Jo 


(A. 9) 


where 


A K° = K; - K pn 


(A.IO.a) 


A K° = -K:+K un (A. 10.6) 

The hyperstability of the feedback block (hence the CLS using Kalman-Yakubovich- 
Popov lemma) is proven for A K p , A constant case. That is where the assumption 
# 2 comes from. 

A K p , A K° constant requirement implies that {K p — A' pn ), and (A* - K un ) a re con- 
stants. If K pn , K un are chosen to be constant nominal gains, then K p , K‘ must be 
constant at least during the adaptation intervals. From eqn. (A. 5), this implies that 
( A p (xp , t), B p {x p ,t)) must be constant during the adaptation process. Equivalently, 
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( A p (xp , t)j B p (x p , <)) must vary slower than the speed of adaptation (which is the as- 
sumption # 2). 

Notice that the condition imposed by the hyperstability is not that K py K* should be 
constant, but ( K* - K pn ), and ( K* - K un ). If nominal feedback gains are not constant, 
but somewhat better in keeping the plant track the reference model, then assumption # 
2 would not have been so restrictive. Choosing variable K pn , K un nominal gains based 
on the decoupled joint control algorithm [Whitney 72] where generalized inertia matrix 
plays a significant role, assumption #2 may be relaxed as follows: 

The previous assumption # 2 wa s: 

The difference between the reference model and the closed loop plant 
dynamics under constant linear nominal control should vary slower 
than the speed of adaptation. 

The new assumption # 2 is: 

The difference between the reference model and the closed loop plant 
dynamics under variable nonlinear nominal control should vary slower 
than the speed of adaptation. 

A. 2 Generalized Inertia Matrix Based AMFC: 

Application to Flexible manipulators 

Consider the flexible manipulator model 


' m r {9,6) m rf (9,6) 

"e 

_ 1 _ 

\Lr 1 


Q 

JL 

<7 r ‘ 


u 

mJ f (9,S) m f (0,S ) 

£ 

*T 

Ilf J 

T 

.{K}6. 

i 

.If. 


.a. 


m r( H “ [ m r/!+ / r + {A. 12) 

!£ = £ r +M p (A13) 

m r ( 9,6)9= u p + [m r /6 + / r + ( ^ “ £,.)] (-4.14) 
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where g r is gravity compensation (feedforward). During the gross motion, nonlinear 
terms and coupling from the flexible modes to the joint variable dynamics are treated as 
a disturbance and to be taken care of by the closed loop system robustness. 

Under the influence of a gravitational field, a flexible arm will deflect. Designing a 
control system which uses the static deflections as the nominal value for flexible states 
as opposed to zero would be more accurate. 


Let the desired reference model be 


and the control law 



(A.15) 


Up = ~ K pXp + Kx iU m + K m x m 

= -KpnZp + ^un« m + Atfp(e, t)x p 4* AX u (e, t)^ 


(A.16) 


Nominal control 


Adaptation algorithm control action 


The nominal control can be chosen in the form (as used by the computed torque method), 
[Luh et. al. 80, Cetinkunt 87]. 

Hpn = dir(£, £()«„, + m r (£, Stt) [[c,-, - Ai]^, + [fc,< - Ao]^ + [M£o] 

(A. 17) 

- m P ( 6 , 6 3t ) [[c,-,]£ + [*,«] 

The nominal gains for the adaptive model following control algorithm based on the 
generalized inertia matrix is given by 


K un = m r (i, 6, t ) (A. 18. a) 

I< pn = m r (&, £,,)[[*«] , [c„]j (A. 18.6) 

K mn = m r (£, £,,)[[*«] - A 0 ], [c,<] - Ai]| (A.18.c) 

If error dynamics eigenvalues are equal to those of the reference model, then ; fc„ = A 0 , 
Cii = Ai => K mn = 0. The m r (& , <5„) term in the control algorithm is the key for 
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decoupled control of joints. The adaptation algorithm should be designed such that 
when added to the nominal control vector u pn , the decoupled nature of the control is 


preserved. The adaptive part of the control is: 


A K p = f F pl v[G pl x p> ] T dr + F p 2 i:[G p2 £,] T (A 19 .a) 

Jo v s v ' 

^ Proportional Adaptation] AK^ r 

Integral adaptation, AK p . 


A K„ 


J F u \ ylGuiUrn] T dr + F u 2 ll[Gu2Um] J 


Integral adaptation, AK M , 


Proportional Adaptation \AK 


(A. 19 . 6 ) 


Any positive definite matrix of appropriate dimension for F p 1, F p2 , G v 1, G v 2 , F u 1, F u2 , 
G«i ? Gu2 would be sufficient (but is not necessary) to guarantee the global asymptotic 
stability of the control system with an appropriate output filter. For an n-degree of 
freedom system with m number of inputs; F pl , F p2 , F ui , F u2 , G u 1, G u2 G F mxm , and G pi , 
G p2 G i? nxn . There are too many design parameters which can be chosen arbitrarily 
from a large admissible class. Neither the hyp erst ability based design nor Lyapunov 
methods give any guidelines for the selection of the elements of these matrices. As 
the system dimension increases, finding appropriate adaptation algorithm parameters 
becomes a more serious design problem. 

The proposed AMFC design method solves that problem to a great extent. Since 
decoupled control calls for the use of the generalized inertia matrix, one should utilize 
this fact in the adaptation algorithm to direct the adaptation algorithm in the right di- 
rection. The following adaptation algorithm, which uses the generalized inertia matrix, 
will guarantee the global asymptotic stability of the closed loop system. 


A K v = A K pi + A Kt 


Vpp 


l 


= / Ppirhrilc, dr + p pp rn r (8^, 6,,) v x p 


(/l. 20. a) 
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A K u = A K ui + A K, 


up 


= j Pui thrOe, 6 tt )vi£,dT + p up m r (0 o , l, t )vy,l 

J O 


(A.20.6) 


The generalized inertia matrix based AMFC algorithm described by (A. 16), (A. 18) 
and (A.20) has the following advantages over previous algorithms: 

1. The use of the generalized inertia matrix immediately solves the magnitude 
selection problem of the adaptation algorithm, for it is naturally compatible with 
the problem in the sense that it preserves the decoupled joint control. 

2. The number of design parameters for integral adaptation is only 2, for integral 
plus proportional adaptation is 4, no matter how many degrees of freedom the system 
has. Thus the design problem of finding the good adaptation parameters becomes 
much simpler. 

3. Utilizing the generalized inertia matrix as an integral part of adaptation im- 
proves the decoupled response of joint variables. 

4 The use of variable nominal gains results in less restrictive conditions on the 
applications of AMFC to nonlinear systems. 
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Table 1 


Manipulator model parameters 


Geometric properties of uniform, slender links 
(link 1 and 2 are identical) 

Length of link i (/,-) 

Cross-section area of link i (A<) 

Cross-section area moment of inertia about z-axis (/*<) 
Link material properties (Aluminum) 

Mass density (/?,■ ) 

Young’s modulus of elasticity (£„•) 

Resultant link inertial and structural properties 
Mass per unit length (piAi) 

Mass of link i 

Flexural rigidity of link i (Eil zi ) 

Lowest natural frequency of the arm (u/ cc i) 

(both joint are locked, and 0 2 = 0 ) 

Joint inertial parameters 

Joint 1 and 2 masses (m ; i,mj 2 ) 

Joint 1 and 2 mass moment of inertia about the joint 
center of mass ( Jji, Jj 2 ) 

Payload inertial properties 
Mass (m p ) 

Mass moment of inertia about the center of mass (J p ) 


Value 


2.0 m. 

7.224xl0~ 4 m 2 
7.6190xl0~ 9 m 4 

2768.8 kg/m 3 
7.0xl0+ iO Nt/m 2 

2.0 kg/m 

4.0 kg 

533.33 and 5333.33 Nt.m 2 
3.59 and 11.35 rad/sec 


0.0 

0.0 


0.0 to 2.0 kg . 
0.0 
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SYMBOLIC MODELING AND DYNAMIC SIMULATION OF ROBOTIC 
MANIPULATORS WITH COMPLIANT LINKS AND JOINTS 

Sabri cetinkunt* and Wayne J. BooKf 

•Department of Mechanical Engineering, University of Illinois at Chicago, Chicago, IL 60680 US.A_andtThe 
George W Woodruff School of Mechanical Engineering, Georgia Institute of Technology, Atlanta, GA 3033., 

U.S.A. 

The explicit, non-recursive symbolic form of the dynamic model of robotic manipulators with compliant links and 
joints are developed based on a Lagrangian-assumed mode of formulation. This form of dynamic mode is 
suitable for controller synthesis, as well as accurate simulations of robotic applications. The final form of the equations 
is organized in a form similar to rigid manipulator equations. This allows one to identify the differences between 
rigid and flexible manipulator dynamics expUcitly. Therefore, current knowledge on control of rigid manipulators 
is likely to be utilized in a maximum way in developing new control algorithms for flexible manipulators. 

Computer automated symbolic expansion of the dynamic model equations for any ' s 

accomplished with programs written based on commercial symbolic manipulation programs (SMP, MACSYMA, 
REDUCE). A two-link manipulator is used as an example. Computational complexity involved in real-time connro , 
using the explicit, non-recursive form of equations, is studied on single CPU and multi-CPU parallel computation 
processors. 


NOMENCLATURE 

q 2ij jth generalized coordinate asso- 

ciated with element 2 i 

n 2i number of generalized coordinates 

associated with element 2 i 
N total number of links 

x 2iJf y 2iJf z 1Ui yth mode shapes for the deflections 
of element 2/ in the x 2i , y 2i , z 2i axes 
directions, respectively, 
homogeneous transformation mat- 
rix from coordinate frame 2i to in- 
ertial coordinate frame 
homogeneous transformation mat- 
rix from coordinate frame (2 i + 1) 
to coordinate frame (20 
kinetic energy of the system 
gravitational potential energy 
elastic potential energy 
spatial variable along element 2 i 
mass distribution of element 
uniform mass distribution value 
generalized coordinates associated 
with joint angles between links 
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q 2 

generalized coordinates associated 
with link flexibilities 

qj 

generalized coordinates associated 
with joint flexibilities 

m 2i - 

mass of element 2i (link i) 

E 

Young’s modulus of elasticity of 
the material 

G 

shear modulus of elasticity 

(I x )li, (/,) 2 £. (hht 

area moment of inertia of element 
2 i cross section about x 2i , y 2i , z 2i 
axes, respectively. 

M x)2i 

cross section area of element 2i. 

intm 

maximum rounded integer, e.g. 
intm{ 5.2, 6.3) = 7 

m 2i -i 

mass element 2 i — l (link i) 

hi - 1 

inertia tensor of element 2 i — 1 with 
respect to a coordinate frame fixed 
at its center of mass 

in 

generalized inertia matrix of all 
joints 

g 

gravity vector, [g x , g y , g z >®Y 


generalized mass matrix element 
with row index (p, r\ and column 
index (s, t) 

ip, r) 

p~ l 

row index: £ n- x + r 

i* 1 


j - 1 

( 5 , t) column index: ]T + t 

i - 1 


^2 i 


K 

Pe 

12 i 

Mo 

qi 
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1. INTRODUCTION 

1.1 Motivation for the work 
Computer controlled robotic manipulators are very 
versatile elements of modern flexible manufacturing 
systems. Their versatility stems from two main 
characteristics: (1) mechanical reconfigurability, (2) 
reprogrammability with the control computer. There 
is an increasing demand for the utilization of robotic 
manipulators in many manufacturing operations such 
as milling, grinding, drilling, and deburring. Further- 
more, manipulators are required to complete their part 
of a job in shorter times, in order to reduce the cycle 
time and thus improve productivity. This requires 
manipulators to move faster and faster. 

The compliance of manipulators due to links and 
joints becomes a significant factor affecting the 
precision of manipulation as the manipulators move 
at high speeds and/or interact with large contact forces. 
In order to operate within a desired precision range, 
the computer control algorithms must account for 
previously neglected manipulator compliance. Under- 
standing and appropriately accounting for the com- 
pliance in control is a prerequisite for the utilization 
of manipulators in the forementioned high-perfor- 
mance tasks. Therefore, effective means of modeling 
the dynamics of manipulators, including the link and 
joint compliance, is needed. 

In general, there are two different reasons for 
mathematical modeling of any dynamic system, and 
for that matter, compliant manipulators. 

1. Study and simulate a system before it is actually 
built. For that purpose, the model should be as 
accurate and detailed as possible to closely represent 
(model) the actual system, so that the predicted 
behavior will be close to the actual behavior of 
the real system. 

2. Model only the major characteristics of the system 
so that it is simple enough to synthesize an 
appropriate control algorithm, and implement it in 
real-time. Explicit, symbolic form of the flexible 
manipulator dynamics presented in this paper offers 
important insights to the dynamic characteristics, 
which is crucial for the development of an appro- 
priate controller. 


1.2 Literature review 

Dyamics and control studies of flexible manipula- 
tors have concentrated on a single joint-single link 
example. 1 ~ 3 The single flexible beam is modeled as a 
Bemoulli-Euler beam and infinite dimensional vibra- 
tion coordinates are truncated to a finite number of 
modal coordinates. Joint flexibility is considered as a 


torsional spring coupling the actuator rotor/gear 
assembly to the link. 

Previous work on the Lagrangian formulation based 
dynamic modeling of multi-link flexible manipulators 
can be classified into two groups: 

1. Lagrangian — finite element based methods, 

2. Lagrangian — assumed modes based methods. 

The small vibration dynamic models of flexible 
mechanisms and manipulators are developed about 
known nominal joint variable trajectories. 4 The coupl- 
ing effects of deformation coordinates on the joint 
motions were neglected. This assumption is removed 
in Ref. 5. Static deflection modes are included in the 
model in addition to dynamic deflection modes, thus 
improving the accuracy of model. 6 A two-link flexible 
arm is modeled with a Lagrange-finite element based 
method, and the performance of linear quadratic 
regulators (LQR) with prescribed degree of stability is 
studied. 7 In a recent work, a Newton-Euler formula- 
tion and Timoshenko beam theory are used. 8 Stiffness 
matrix accounting for combined flexibility of joints 
and links is derived again for a two-link example. 9 The 
main advantage of finite element based methods is that 
they can be applied to complex shaped systems, 
covering a wide class of problems. However, the main 
disadvantage is that they do not give much insight to 
the dynamic structure of the system. 

A general Lagrangian-assumed modes based meth- 
od is presented in Ref. 10. The equations of motion are 
developed in recursive form to reduce the real-time 
computation in inverse dynamic control. A symbolic 
modeling method based on Ref. 10 is developed in 
Ref. 11. Transfer matrices are used to develop linear 
frequency domain model of servo controlled manipula- 
tors. 12 The method of 10 is attractive for the following 
reasons: 

1. It is an easy-to-understand conceptual approach: 
therefore, utilization of the results by other re- 
searchers in the robotics field will be at a maximum. 

2. As a result of using an independent set of relative 
coordinates in the kinematic description, the 
dynamic model has a form similar to the rigid 
manipulator models. Therefore, it provides more 
insight to the dynamics of the system and may 
suggest modifications of rigid manipulator control 
algorithms for use on flexible manipulators by 
exploiting the differences between rigid and flexible 
manipulator dynamics. 

1 PROBLEM STATEMENT 

Explicit, non-recursive, symbolic modeling of robo- 
tic manipulators with compliant links and joints is the 
problem dealt with in this work. In order to accurately 
study and simulate the behavior of the system, the 
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modeling method should yield accurate models. Yet 
simpler models conveying only dominant character- 
istics of the dynamics are needed for successful 
controller design. The Lagrangian-assumed modes 
based method described in Ref. 10 fulfill these require- 
ments. A recursive formulation is useful and critically 
important in computed-torque control. However, the 
non-recursive, direct dynamic form of equations is 
needed for more general simulation and controller 
synthesis studies. If the multi-cpu parallel computation 
is needed in order to implement a detailed dynamic 
model based controller in real-time, the recursive form 
of equations is not suitable, rather, the explicit, 
non-recursive form is desirable. 

3- SYMBOLIC MODELING OF FLEXIBLE 
MANIPULATORS 

L Flexible-arm kinematic description 
Consider the kinematic structure shown in Fig. 1 
representing a manipulator with serial links connected 
by revolute joints. The elements of the manipulator 
are numbered, and body fixed moving coordinates are 
assigned as shown, where O 0 XYZ is the inertial 
coordinate frame. 4x4 homogeneous transformation 
matrices are used to describe the position and 
orientation of one coordinate frame with respect to 
another. Let = <?k, 2 > •••• be the gen- 

eralized coordinates associated with the degrees of 
freedom (d.o.f.) of element k. For instance, if element 


k is a single d.o.f. revolute joint, then = q kA , if it is a 

two d.o.f. revolute joint, then = 

element k is a flexible link, q kJ is a vector of modal 

coordinates, if the link is rigid (zero d.o.f.), q kJ is a null 

vector. 

The position vector of a differential element along 
link / (element 2i) with respect to coordinate frame 2/ 
is given by (Fig. 1) 

«[*«, o,o, i] r 

+ Q2t,jL x 2t.j’ yaw. z 2i.j> 0] T - M ■ 

i-l 

The second summation term in (Eq. 1) describes the 
deflection of the element 2 i at that point in terms of 
modal coordinates approximately. The x 2i z nj 
are the/th mode shape functions of the element in x 2i , 
y 2i , z 2l directions, respectively, q 2i j is the generalized 
modal coordinate, n 2i is the number of modes used to 
describe the deflection of element 2 L The absolute 
position of this point with respect to the inertial frame 
O 0 XYZ is given by 

(2) 

where °W 2i . x is the 4 x 4 homogeneous transforma- 
tion matrix from coordinate frame 2 i to the inertial 
coordinate frame (Fig. l)t 

W 2i . l =A l A 2 .. (3) 


tPrecediiig superscript 0 will be dropped for notational simplicity. 



Fig. 1. Kinematic description of serial link flexible manipulators. 
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Hence 



/4 2i — 


1 0 0 / 2i 
0 10 0 
0 0 10 
0 0 Q 1 


+ 1 
J-i 


0 


*2i., 


0 

yii.j 


(®Jaw 

0 Z 2i.j 

0 

0 

0 0 


( 9 ) 


A 2l -i (for / = 1, . . . , N), are joint transformations and 
no approximations involved in their description. 


Note that if a link is considered rigid, the corresponding 
link transformation will be a constant matrix. Approxi- 
mations are involved in the definition of link trans- 
formation, A 2i , as described below. If link i (element 
2 i) was a rigid, slender beam, A 1{ would be (Fig. 2) 


^2 i — 


1 0 0 l 2i 
0 10 0 

0 0 10 

0 0 0 1 


(4) 


The change in the position and orientation of the 
(2/ + 1 )th coordinate frame due to the flexible deflection 
of link i is described by a differential coordinate 
transformation (Fig. 2). This is an approximation in 
the kinematic description. The approximation is valid 
to the extent that the orientation change of coordinate 
frame (2 i+ 1) due to deflections is small enough to 
justify the following approximation: 


sin — & 2 i’ C0S ® 2 i — F 


(5) 


where 0 2i is the equivalent rotation angle about an 
axis of rotation to transform the orientation of (2/ + 1) 
to that of the (2/ +1) th coordinate frame. This 
approximation is well satisfied in robotic applications. 
Finally, the link transformation A 2i , 

A 2i = A 2i + dA' 2i (6) 

dA' 2l = A' 2i - A '" A. (7) 


Invoking the modal approximation for the deflections 


= 


0 (Oyhi *2 i 

(0 Z ) 2 i 0 -(0,) 2i >2i 

-(Oyhi {0 X hi 0 *21 

0 0 0 0 



0 


(0 z )2iJ 

-OyhiJ 

0 


0 

(flj 2LJ 
0 


(Oyh i J 

0 

0 


yuj 


( 8 ) 


z 2i.j 

o 


3.2 Flexible-arm kinetics: Lagrangian-assumed modes 
formulation 

Once the kinematic description of the system is set 
up, the next step in Lagrangian formulation is to form 
the kinetic and potential energies and take the 
necessary derivatives of the equations of motion: 



{r = 1, .... /! p }} (10) 

where 

iV 

K — Y K 2 i — total kinetic energy (11) 

i- 1 
S 

P = Y ^ 2 i — total potential energy (12) 

i* 1 

Q p r — the generalized force vector. (13) 

Here only the link dynamics are considered. Inclusion 
of the joint dynamics into the model will be discussed 
in Section 3.4. Kinetic energy of element 2/ (link /) 

K 2i = 1/2 £‘ Tr{°h 2i ■ °AiiWif)dif (14) 

= (15) 

°M*> = K - 1 ■ 2 %,W + w 2 i - 1 • 2, Kin) (16) 

where 



2 %i = f. $2lJ. X 2i.j’ y2i.J’ Z 2ij> °] r < 18 ) 

Substituting Eqs (15) to (18) into (14) and summing 
over / as in (11) yields the kinetic energy of the 
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manipulator links 


N 2f-l 2i-l n, n. ( SW-,, 

K-iPz. i 1. 1 


1-1 I- l U-l f 1 K- 1 


c„ 


+ ^ ICliJ + ^2»,;]^2tj 

J m 1 

Jy 1 • • 

+ 1 I CziJJtQzw/hiJt “TT 

;-l fc-1 J 

+ £ 

i*l j- 1 r-l* \ vQs,t U* 1 


+ i I C2iJ,kQ2L,kQliJ 

1 k- 1 

+ 1/2 _£ 




^ ]L ^2i.].k^2i,i^2i.k ^2i - 1 I (19) 


where 


C 2i = J , “ [*„, o, 0, l] r 0/ 2i) 0, 0, m^r, (20a) 

rw 

^2i,j ~ J C^?2i» 1 1 [+ 2 i.J’ y 2 i.j' ~ h.}‘ 


C 2i.j,k I y2i,j> ~2i,j' 

Jo 


0]/4>7)d'? 

(20b) 


0] 7 


[^2ij. z 2i,;» 0]/i(»K)dn- (20c) 

The potential energy of the system is given by 


P = P, + P'=1 KP'ht+iP'hil 

t * 1 

The gravitational potential energy, P g7 

P t = Z f ? r ^2i-i 2 'M^)M>/)d»i 
i*l JO 

Substituting li h 2i from (1) into (22) 


mg 2i + t ?2i.j ff *«2M 


i- i 


1= 1 

where 

fl r 9.. 0] = [0,0, -9.81,0] 
C<2‘ 

mu = I C72i. o, i] r nfa)d»f 

fW 

"»«2i.y = I [>2..j> >2i.y. z 2i.r °] r M'?)d'l- 


( 21 ) 

( 22 ) 

(23) 

(24) 

(25) 

(26) 


Incidentally, me 2iJ is same as the bottom row of C 2iJ 
in (20b). 


The elastic potential energy expression, considering 
bending in the y, z, extension in the x, and torsion 
about the x directions, is given by 

(27) 



Noting the truncated modal approximations for the 
deformation coordinates of the links [Eqs (1) and (9)] 


P, = 1/2 t t i ^2i,j.k C l2Uj < hi,k (^8) 

i* 1 j* 1 ** 1 

where 



Note that the k 2iJik term is the same structural stiffness 
value that would be obtained numerically from finite 
element methods. 


3.3. Dynamic model: non-recursive form 

For general purposes, such as simulation and 
controller synthesis studies, the non-recursive dynamic 
form of the model is needed. For computed-torque 
(inverse dynamic) control, which is a specific control 
algorithm, the recursive form is desirable. 10 The 
components of the dynamic model should be explicitly 
separated out into inertial, centrifugal and Coriolis, 
gravitational, and structural stiffness terms, so that 
this information can be embedded in the structure of 
the real-time control algorithm. For instance, the 
generalized inertia matrix plays a critical role in 
decoupled joint control of robotic manipulators. In 
order to implement a real-time decoupled joint 
controller for a given manipulator, the generalized 
inertia matrix must be known explicitly so that it can 
be used in control action calculations. In contrast, the 
recursive formulation avoids such separations to 
reduce the number of operations needed for inverse 
dynamic calculations. The non-recursive explicit form 
of the dynamic model is presented below. If the 
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necessary derivatives are taken, and the terms gen- 
erated by - 7 ^ dK/dq pr ) and ( 5K/dq Ptr ) in Eq (10) are 
at 

cancelled, the resultant system of equations can be 
organized in matrix form, 

[Af(q)]q 4 - C( q, q) + G(q) 4- [K]q = Q (30) 

where 

q = [(* 1 , 1 » *1,2> • • • » *l,i»|)» (*2, 1 » * * * » *2 * * * 1 (*2V,1 » 
• • ■ > 

One row of this matrix Eq. (30) corresponding to q p>r 
may be written as 

IS n. 

1 t 


m {p,r).{s,t) 4 s 4 + 4 ) + 

i- 1 r» l 

2 * A 

+ X Z = Q(P^) 

J« 1 (» 1 

where 

p- i 

£ n { 4 * r = row index (p, r). 

i* 1 
j-i 

I 

i« 1 


(31) 


£ n, + 1 = column index (s, t) in Eq. (30). 

i m 1 

Elements of the generalized inertia matrix: 

m {p,r).{3.l) = "Cmm) 4 " "I" m {p.r).is,t) 


(32) 


(^r'-f) 

+ ^ 2 i,J* 2 t,> 

+ 1 I 


j * 1 k = 1 


(32a) 

i 

(32b) 

(32c) 


dWg-t 

5?,., 

C,, + 

( 3 , f w,-iC„vr;-t; * = p 

j 0 ; s#p. 

Elements of the nonlinear centrifugal and Coriolis 
terms vector: 

" i i [ d*W2i-l 

c , P .„(q. i)-.!, Sj ,?i 

fr^) 

x J^i + £ [ C 2(.J + ClijiQii'i 

^Z( !hi 

+ ^2iJ.k*2i.j*2i,i 

j * 1 k ■ 1 

awS-i . . 

■* 5 *3 

^*p.r 


2i-l rt, 

+ I z 2 j> 

i ■ inim j * 1 1*1 


. 8 9p.r 


e-v-v 

x J^2 ^ C 2L) q 2i ,j 
+ 2^2 C lu , k q 2iik q zi .i 

j- 1 *«1 

3^5-1 . \ p v l "v - 1 ^ X 

x- 5 7- i 4 M )+ I I I I Tr 

.(^kAc„,J 

L k=i J 

\ p - 1 a 

x [ 2 > ? 1 c '"’'- , ] H '’ r " (33) 
Elements of the gravity vector 
n Q\y f 

G„.r,(q)= I 9 T -^r 1 m 9n + I »*aw92w 

i * u»rn» ^*p,r L * _ 

+3 T V»;_ 1 me,. r . (34) 

Elements of the structural stiffness matrix 



\c 2i + 2 [C 2Ut 

_ f 

\ 3q M 

L i-1 

k{p,rU3,t) — j 


W for p = s 
3 for p t* s. 

Note some simplifying facts as follows 
c,.„ *p. r .. = 0 for p odd 

W - 1 


^*p,r 


• = 0 for s — 1 < p 


(35) 

(36a) 

(36b) 


In symbolic expansion of Eqs (32) to (35) for a 
manipulator, these facts (36a), (36b) will be automatic- 
ally utilized and will cancel out the terms that are 
already known to be zero. Such capabilities are 
conveniently provided by commercial manipulation 
programs (SMP, MACSYMA, REDUCE). 

Considering (35) and (36), and rearranging gen- 
eralized coordinate vector into two groups associated 
with joint and link flexibility 

Cqf. q[] = [tel,;. 9i.j' ■ • ) r . 9*.r ■ ■ ) r ]- (37) 

The equations of motion (30) can be shown to have 
the following form: 

f *ir ffv/ fail + fc r (qi, q 2 , qi* <h) j + <\i) 

\mj f m / Jjq 2 J lc r (q lt q 2 , *2)3 lG/(qi, q 2 ) 


’0 
' _0 


*1 

^/Jlq 2 


( 38 ) 



Robotic manipulators with compliant links 

3.4 Inclusion of joint dynamics 

Inclusion of joint dynamics into model involves 

1. modifications of Eqs (20a-c), (25), and (26) by 
redefining mass distribution of links, 

2. augmenting a set of second order equations to (38) 
as a result of joint flexibility and inertia. 

DC motor-driven revolute joints whose rotor/gear 
arrangement is elastically coupled to the links will be 
considered. Joints can have more than one degree of 
freedom. Elastic mechanical coupling between a joint 
and link is modeled as a torsional spring. The following 
assumptions are made regarding the joint assembly 
mass distribution. 

Assumption l : Rotational kinetic energy of each joint 
about is own center of mass is only due to its own 
rotation. Rotational kinetic energy due to rotation of 
previous joints and links is neglected. This amounts 
to neglecting terms in the order of gear reduction ratio, 
which is typically in the order of 1 : 100. Translational 
kinetic energy due to both previous joints and elastic 
deformations is taken into account. 

Assumption 2: Rotor/gear assembly inertia is sym- 
metric about the rotor axis of rotation such that 
gravitational potential energy, and translational velo- 
city of joint center of mass are independent of rotor 
position. 3 This assumption is generally satisfied by 
joint assemblies of most industrial robots. 

Let q l = [(q^i , • • ■ , <?¥!,,). >•••• <?£,,). • • ■ 

•••• 

be the generalized coordinates associated with joints 
(Fig. 3). The relative motion between a joint rotor and 
elastically coupled link is (42i-i.r~4Vi-i.i-)- The 
contribution of the joint dynamics to the equation of 
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motion will be reflected through kinetic, potential 
energies and generalized forces. The kinetic energy of 
joint i (element 2i— 1) is 

K 2{ - i = 1/2^21- l(K/)Ii- 1 ‘(K/)2i- t 

+ 1 ( 39) 

where m 2i - l is the mass, (V G ) 2/| velocity of center of 
mass, w 2i -\ angular velocity vector, [/ 2 i-i] inertia 
tensor with respect to a coordinate frame fixed at the 
center of mass of joint. From assumption 2, (Vg)u-v 
will be function of the generalized coordinates of 
proximal elements and will not depend on 
Therefore translational kinetic energy of joint i can be 
included in the formulation by considering its mass as 
part of the proximal link. This is accomplished by 
redefining mass distribution of link (i — 1) as 

Pzi-2 — /*o + w 2 i- ~ hi- 2 ) 
where 


d(r\ 




for fj = l 2 i -2 
for riitlu -2 


(41) 


and evaluate Eq. (20a-c) with new definition of n as 
in (40). 

From assumption 1, w 2i _. *qV]-i., 


K 2i - t = l/2(q$- i^) r [f 2 i- JAj]- i.f 
For all joints of the manipulator 

k X *2i-i = i/ 2 ql • 

i-intm 

&'■¥) 

The contribution of joint potential energy to the 
dynamic model equations is 


(42) 

(43) 


yU) = yU) + yy) (44) 

From assumption 2, the gravitational potential energy 
of joint i may be included in that of link (/-l) by the 
evaluation of (25) and (26) with pfn) as defined in Eq. 
(40). The elastic potential energy stored in elastic 
coupling between joint and links is 


Kf*- l/2(qi -q 3 ) r Diag{K t }( q x -q 3 )- (45) 

As a result of the contributions of (43) and (45) 
equations of motion (38) is modified to the following 
form: 

m, m r/lf i il| 12. 4l* 42)1 + <h) l 

[ _m$f "»/ jtai jc/q!, q 2 , 4i, q 2 )j <k)J 



[•f]{4a} + [KJfas -qj - i u } 


(46a, b) 
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El§m«nt No. 1 

Fig. 4. Two-link flexible manipulator example. 


4. A CASE STUDY 

The described modeling method has been applied 
to a two-link planar flexible arm, with single d.o.f 
revolute joints (Fig. 4). In this case study, only the link 
flexibilities are considered, the joint flexibilities are not 
included. The bending deflections of links are approxi- 
mated with two assumed mode shapes for each link. 
Mode shapes are chosen from the analytical solution 
of a Euler-Bemoulli beam eigenfunction analysis but, 
of course, could also be otained using a finite element 
analysis program. The mathematical model is symboli- 
cally obtained using SMP symbolic manipulation 
program and simulated with a VAX-l 1/750 micro- 
computer with the following objectives: 

1. Verify that the model generated by the above 
algorithm is correct, 

2. Demonstrate the ease of changing mode shapes for 
the given example manipulator, and study the effect 
of using different mode shapes on the predicted 
dynamic response of the system. 

Model verification is supported by comparing the 
response of the flexible arm model with that of rigid 
arm model. Clearly, as the flexural rigidity, £/ r , of the 
links increase, joint angle response of the flexible model 
should converge to that of rigid model. This is observed 
as shown in Figs 5 and 6a, b. In the simulations of 
Fig. 6, mode shapes corresponding to clamped-free 
boundary conditions of a beam were used in the model. 
Now, let us consider the case that one would like to 
use a different set of mode shapes. The necessary change 
required in the model is to re-evaluate the following 
terms with new mode shapes (considering the fact that 
selected mode shapes form an orthogonal set): {C 2/J , 
C 2i>M , for i=l,2 and j * k = 1, 2: (C 2il1 C 2t2 , C 4<1 , 



£4,2)1 (£ 2 , 1 . 1 ’ £ 2 , 2 . 2 > £4,1,11 £4.2,2)* (^ 2 . 1 . 1 ' ^2.2.2* 
K 4>1<1 , K 4 , 2 . 2 )}, me 2iJ must be updated with the new 

values of the fourth row of C 2iJ . Figure 7a-b shows 
the same simulation case results of flexible model with 
clamped- clamped mode shapes. The reason for the 
faster convergence of joint angle responses compared 
with those of the rigid model is that clamped-clamped 
mode shapes results in a stiffer model than clamped- 
free mode shapes. 

Computational, complexity of the resultant model 
is studied for real-time dynamic control of flexible 
manipulators. These computational results give us an 
idea about the algebraic complexity of the explicitly 
symbolic model and the computational power need 
for real-time control. Since we have obtained the 
equations in explicit, symbolic form, we could simply 
equally distribute the computational load over a 
multi-CPU architecture where each processor could 
work independent of each other. The computation time 
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Fig. 6. Two-link flexible model joint angle responses — clamped- 
free mode shapes: (a) EI { * 10 Nm 2 (b) £/ f * 100 Nm 2 , 




Time ( s ) 

Fig. 7. Two-link flexible model joint angle responses — clamped- 
clamped mode shapes: (a) £/, = 10 Nm 2 (b) £/, = 100 Nm 2 . 


for the inverse dynamics of the example flexible 
manipulator (Fig. 4) is as follows: 

1. Computer: VAX-11/750 

(a) without floating point accelerator: 7 Hz. 

(b) with floating point accelerator: 14 Hz. 

2. Computer: 8 transputer (T414) configuration in 
parallel computation architecture (estimated value, 
not fully implemented): 80 Hz. 

It seems that real-time dynamic control of large 
dimensional flexible systems can only be realized by 
distributing the real-time computation load over an 
array of processors, for the dynamic model equations 
are, in general, too complicated to be handled by a 
single processor at a fast enough rate for real-time 
control. An explicit non-recursive form of equations 
readily lends itself for multi-CPU implementation. 
Since the equations are non- recursive, the computa- 
tional load may be distributed over a multi-CPU 
system where the computational task of each processor 
is independent of others. This is not possible using 
recursive form of model. 


5. SUMMARY AND CONCLUSION 

The elastic deformations are described by summa- 
tion of a finite number of mode shapes which may 
either be assumed or obtained from a finite element 
analysis program. Link deformations are assumed to 
be small enough to justify differential coordinate 
transformation and linear elasticity theory [Eqs (6) to 
(9)* and (27)]. 

The modeling considers all dynamic couplings 
(linear and nonlinear) between deflection and joint 
coordinates. Links are assumed to be slender beams. 
Revolute joints with multiple degrees of freedom are 
allowed. Joint flexibility and link flexibility are 
included. 

An explicit symbolic form of the equations is directly 
useful for simulation and control studies. Computer 
automated symbolic expansion of Eq. (32) to (35), and 
(46) to obtain a dynamic model for any desired 
manipulator structure is studied and an example case 
is presented. The dynamic model is presented in an 
analogous way to the dynamic model of rigid 
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manipulators. This displayed the way link and joint 
flexibility enter the model, i.e. C 2itj , terms in the 
elements of generalized inertia matrix. The mode shape 
dependent model parameters are identified and chang- 
ing mode shapes for a given model is simplified (only 
C 2 ijy C 2i<M , K 2 Ljtk need to be re-evaluated for new 
mode shapes). 

The explicit symbolic modeling method presented 
here has the following advantages : 

1. improves the insightful understanding of dynamics 
of flexible manipulators. 

2. often equations must be simplified for real-time 
control implementation. The importance of each 
term can be determined by simulations, and the 
unimportant terms can be eliminated from the 
symbolic equations. 

3. equations readily lend themselves to multi-CPU 
parallel computation for real-time control. 

4. changing mode shapes for a given model is very 
simple. 

5. the approach is conceptually easy-to-understand 
and similar to rigid manipulator formulations. 
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Abstract 

Dynamic equations of motion of flexible manipulators are 
more complicated than those of rigid manipulators. The 
number of equations of motion increases as the number 
of modes to be included increases. It is difficult to un- 
derstand the effect of flexible motion on rigid motion via 
recursive forms of the equations of motion for multi-link 
arm even if it were efficient. On the other hand, the closed 
form of the equations of motion is useful in understand- 
ing the characteristics of model parameters. However, 
the equations resulting from existing closed forms are too 
complex to serve this purpose. Therefore, a method which 
is structually well organised and computationally efficient 
is developed. 

1 Introduction 

One of the primary concerns in manipulator dynamics is 
computational efficiency. For the efficient form of the ma- 
nipulator dynamic equations, various recursive formula- 
tions for rigid manipulators using L&grangian [6], Newton 
- Euler [10], or Kane’s method [4], have been proposed. 
For flexible manipulators, Book used the method of ho- 
mogeneous transformation matrices. He first considered 
small linear motions of a massless elastic chain [2] and 
later considered distributed mass and elasticity [3]. When 
the recursive formulation is used, the structure of the dy- 
namic model, which is quite useful in providing insight for 
designing the controller, is destroyed. To overcome this 
problem, several programs for rigid manipulators have 
been developed to derive the equations of motion in sym- 
bolic form. Symbolic formulation has the advantage of 
allowing the identification of the distinct components of 
the model. Maiiza-Neto [11] derived symbolically the 
equations of motion of a two link flexible manipulator 
by hand. A systematic method to symbolically derive 
the nonlinear dynamic equations of multi-link flexible ma- 
nipulators was presented by Cetinkunt [5], However, he 
did not explore the structure of the terms in the flexible 


manipulator model. The conceptual framework leads to 
design guidelines for simplifying and reducing the nonlin- 
ear kinematic and dynamic coupling of robot dynamics. 
The physical interpretations and structural characteris- 
tics of the Lagr&ngian dynamic rigid manipulator model 
was drawn by Tourassis and Neuman [13,14]. The mass 
matrix is deduced from the masses and center of gravity 
of links. In turn, the centrifugal and Coriolis coefficients 
are derived from an inertia matrix through the Christoffel 
symbol. However, the method of deriving mass matrices 
is not efficient. Asada [l] presented a method which uses 
the Jacobian matrix to derive the mass and gravity ma- 
trices. This method is found in this paper to be very 
efficient in the modelling of a flexible, manipulator. Low 
[9] used the Jacobian matrix in deriving the equations of 
motion of a flexible manipulator. However, the link defor- 
mation was not represented in the assumed mode method 
and the structure of centrifugal and Coriolis force was still 
complicated and hard to understand. 

In this paper, a Lagrangian method is used to derive 
the equations of motion for a flexible manipulator. The 
Jacobian matrix is used to derive the mass and gravity 
matrices. The Coriolis and centrifugal coefficients are de- 
rived from the mass matrices using the Christoffel symbol. 

2 Derivation of Equations of Mo- 
tion 

The total kinetic energy of an elastic link can be written 

as 

T*TjPiAidXi ( 1 ) 

** i=l J ° 

where f is the velocity vector of any point on the elastic 
link and p t , A t1 / t are the density, the area, and the length 
of link t respectively. The velocity vector can be expressed 
by Jacobian matrix and generalized coordinates. 

r, = Jiq, (2) 
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Substitute (2) into (1), 


T — if / (J,9 1 ) T (J J 9 J )p t /l,(i*, 

“ ,=1 Jo 

= J } P,A,dx,)q } 

= 


Substitute the kinetic energy (3) into (11), 

7t { dq, ] " dt ' E M '^ j) " S A/, ^ J + S di qj 


where 


dt “ dg* dt " ^ 


*=1 J=1 


r 1 ' 

ft] = / J t r J>P,A,dx t 


The- potential energy due to gravity is 


*, = £/ g T r j p : Ajdx i 
>=i y ° 


= H m > ?Tr J (5) 

j=i 

where g is the 3 x 1 gravity vector and 

m > = / PjAjdXj (6) 

Jo 

The potential energy due to elastic deformation is : 

= f‘ fi Ayr fei (7) 

2 "io 5*; ^ 

where E is Young’s modulus of elasticity, and I is the area 
moment of inertia, u is the elastic deflection which can 
be expressed as follows. 

m 

( 8 ) 


Therefore, the elastic energy can be rewritten as (9) 


*-\± ±±£ *>%%*** 

issl jssl fc=l ,/0 J * 

= 5 12 f 12 KijkSijSik 


*=1 ; = 1 Jt=l 


where 


r- 7^' „ r ^ 2 V'k j 

A "‘ = Z 


Lagrange's equation is 


rfg £T gjrr^ 

di 1 3g, ’ dq, dq, Hl ' ' 


Therefore, 

d dT x A .. ^Af tJ . , 

*<a* >*£*«* + EE “55>» 

’’ >=l jrlkrl 

^ 1,3M |; , ajfa,. • 

-•* =E M *^ + EE5 ( if + "^r )<?j9i (14) 

f = 

H dq, 2fri£i 

r* \r* 1 

= ELisr** : ,I5) 

J=1 *=1 

Substitute the potential energy (7), (9) to (11), 

dU g A T Sr, 

* = g-” * 

= E ( 16 ) 

;=i 

where jj 4 ^ is the i th column of Jacobian matrix J , . 

m 

= Yl K '>t 6, J ( 17 ) 

3 = 1 

The Lagrangian equations of motion can be written sym- 
bolically as follows. 

n m 

E Mtj q } + 52 Ktjfdif + (18) 

7=1 7 = 1 ' - 

"'ldMij dM ik dM jts . . Tr u) 

EEjs^+sr— sj r )«*+E”‘n Tj i = * 

J=1 Jbssl ^ * J=1 


52 +5212 C 7k(‘)9j?t + = T . 

7=1 7=1 3=11=1 

(19) 

where q is the vector of generalized coordinates. M is the 
generalized mass matrix, K is the elastic stiffness matrix, 
C is the coefficient matrix of Coriolis andj:entrifugai force, 
G is the gravity force, r is the vector of generalized forces. 
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3 Illustraive Example 

In this section, equations of motion of a planar two degree 
of freedom flexible robot are derived as an illustration. In 
the conventional two serial link robot, there is a difficulty 
in measuring the end point slope a of link AB as shown 
in Fig. l.a. In order to overcome this problem, the flex- 
ible robot with a parallel link mechanism is developed 
as shown in Fig. Lb. The angles 0 2 and are equal 
because link AD and link BC remain parallel. In this 
paper, equations of motion of only link AB and link BC 
are derived because those of the other link can be derived 
similarly. 

3.1 Mass Matrices 

and Gravity Vectors 

Deformed position vectors of each link in Fig. 2.a and 2.b 
are described as follows: 


f\ = (xicos#i — Uijin0i)i 4 (rising 4- Uicos0i)j (20) 

T 2 = [licos 0 \ — tii e sm 0 i 4 X 2 cos( 0 i 4^2) — U 2 jin( 0 i +#2 )j J 

+ [Zismtfi 4 u\ e cos€i 4 X2$tn(0i 4 #:) 4 ti2coj(0i 4 ^2 )]j 

( 2i) 

where i and j are unit vectors along the inertial frame, 
A'o and Yq. The elastic deformation, u t1 can be expressed 
by finite series of mode shape functions which satisfy as- 
sumed boundary conditions multiplied by time dependent 
general coordinates. Suppose that the amplitude of the 
higher modes is relatively small compared with the first 
mode, two modes per link are considered in this model. 

= ^n(*i){ii (f ) 4 ( ^1 )fn(*) (22) 

«2(*2t*) — 4 V /, 22(3 , 2K22(f ) (22) 

The elastic displacement of the end point is 

u lr = ui(/i,f) (24) 

Velocity vectors are related to general coordinates by the 
Jacobian matrix [1]. 


J, = 


— l\S\ - U\ e C\ — U 2 C\2 — —V 2 C 12 “ x 2$\2 
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-V’UeS\ — $12* S\ -V’21-^12 -V f 22^12 

t/> UfCi V'l2f^l V’21^12 ^22^12 

The Jacobian matrix, J\ and Jj, can be easily derived by 
the MJac function of SMP(Symbolic Manipulation Pro- 
gram) [12]. Using the Jacobian matrix, mass matrices and 
gravity vectors are calculated by the following equations: 


n = «Ji9i2 

T 2 — ^ 2<?12 


where 


h = 
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{C,} = £ t (i = 1, 2) (31) 
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The second row of J, is used in the gravity vector since 
the gravity is acting in the negative direction of Iq. 
Elements of mass matrices and gravity forces are: 
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(36) 
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AM X] = f x,rl>, J (x l )p,A,dx, 

(38) 
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NMij = f rl>~j(xi)p,Aidx t 

Jo 

(39) 


where Z* c is center of mass of link i. 

The first three terms are parameters which are related 
to a rigid motion. These are- called zeroth, first, and sec- 
ond moments of inertia respectively. On the other hand, 
the last three terms are parameters which are related to 
a flexible motion. LM^ and AM tJ are called the modal 
momentum coefficients and the modal angular momen- 
tum coefficients respectively [7]. The physical meaning 
of these terms is not easy to explain. However, these are 
have the following properties [7], 


E LM; = m 

J = 1 
oo 

LMjAMj = ml c 
J=i 

2=1 


(40) 
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(42) 
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where 

i>*jt — &>(£*) 

The integrals in equations are labeled as follows. 


m, 


m,l u 


P.Aidx, 

(34) 

x iP x A x dx x 
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NM t j are used for the normalization of mode shape func- 
tions. Generally, these coefficients have been chosen equal 
to 1 or the total moment of inertia of the link. 

3,2 Centrifugal and Coriolis force 

The velocity coupling matrix which are consist of coeffi- 
cients of centrifugal and Coriolis force can be derived from 
the mass matrix using the Christoffel symbol [13,14]. 

<«> ' 

C jk (i) characterizes the effects on link i which are caused 
by the coupled velocities of link j and k. The diagonal ele- 
ments for j ss k are the coefficients of the centrifugal force. 
The off-diagonal elements for j ^ k are the coefficients of 
the Coriolis force. 

In the flexible arm dynamics, the states can be parti- 
tioned into the rigid states 6 and the flexible states <5. 

2 6 2 2 2 6 
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* = 1 j =3 j = l *=1 2 = 1 *=3 


4 


6 6 


+ E E Rjk{i)t]t>k + C, — r t (i — 1, 2) 

j=3 Jc =3 


(44) 


: 6 2 2 2 6 

E *^+E *m>E E brtM+t, E $*( w* 

j=3 j = 1Jc = 1 ;=lk=3 


t=l 


6 6 
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Therefore, each velocity coupling matrix can be written 
as follows: 
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Jo 

(51) 


Because mass submatrix are not the function of elas- 
tic state in equation (29), Rjh(i) is eliminated. The 
number of independent centrifugal and Coriolis coeffi- 
cients also can be reduced using the symmetry and the 
reflective coupling properties [13,14]. 

Cj k (i) = C k j(i) (52) 

Cjk(i) = -C 3 i(k) for j <i,h (53) 
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The reflective coupling property that Tourassis and Neu- 
man finds for rigid arms is not always valid in the flexible 
case. Therefore, even though the symbolic manipulation Using these coefficients, the velocity coupling matrix for 
program can be nsed as the computational tool, the sim- the two bnk exam P le ““ b « simplified as follows: 
plication procedure must be completed under the super- 
vision of the analyst. 

Using these properties, the following independent terms 
are drawn from elements of the velocity coupling matrix ’ C(l) = 

Cj *(*)• 
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4 Conclusion 

Mass matrices and gravity vectors are directly derived 
from the Jacobian matrices which are easily calculated 
from positon vectors by SMP. Because the deriving pro- 
cedure is simple, it reduces the possibility of producing 
the incorrect equations. Furthermore, this form can eas- 
ily expand the model to higher modes expanding elastic 
deformations as series of mode shape functions. The coef- 
ficients of centrifugal and Coriolis force axe derived from 
the mass matrices by Christoffel symbol and are simpli- 
fied by using several structural properties. The resulting 
velocity coupling matrices have a structure which is useful 
to reduce the number of terms calculated, to check cor- 
rectness, or to extend the model to higher order. Some 
procedures for deriving the velocity coupling are not com- 
puterized. In the future, an even more systematic deriva- 
tion method may be possible. 
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CONTROL OF A SMALL WORKING ROBOT ON A LARGE 
FLEXIBLE MANIPULATOR 
FOR SUPPRESSING VIBRATIONS 

Soo Han Lee 
Wayne J. Book 

The George W. Woodruff School of Mechanical Engineering 
Georgia Institute of Technology 
Atlanta, Georgia 30332 

The vibrations of flexible manipulators have been usually damped out by using the 
joint actuators. The joint actuators must have a larger bandwidth than flexible vibrations. 
This means that the additional use of joint actuators has larger torque per link weight ratio 
(or actuator weight per link weight ratio) compared to a rigid link robot. The high weight 
ratio degrades an advantage of flexible manipulator, light weight, especially when a flexible 
manipulator is long. A simple solution to decrease the weight ratio is to use joint actuators 
for only nominal position control. The vibrations are suppressed by a passive damping 
treatment or momentum exchange devices that increase total weight. A flexible 
manipulator at Georgia Institute of Technology gives another solution, that is, damping out 
the vibrations by using inertial forces of a small rigid robot carried by large flexible 
manipulator. 

An approximately human scale three degree of freedom research robot designated 
SAM (Small Articulated Manipulator) can change the direction of inertial force by 
changing joint angles and joint torque directions. The direction of the inertial forces affects 
the vibration suppression effectiveness. The most effective angles and torque directions of 
the small robot depend on the mode shape of a large flexible manipulator designated 
RALF (Robotic Arm, Large and Flexible). Also the mode shape of flexible vibrations 
varies with the angles and joint torque directions of the large manipulator. The issues 
related with the angles (nominal position) and torque direction (inertial force management 
scheme) are addressed. 

A small robot carried by a large flexible manipulator suffers from relatively large 
acceleration and nonlinear forces. The controller of a small robot should keep the robot at 
a nominal position and follow a predetermined inertial force management scheme for 
damping the vibration of the large manipulator. The control law should be simple and 
effective in order to overcome the speed limit of computations. Studies on this control 
issue are also addressed. 
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ABSTRACT 

Initial experiments on state space feedback control of 
a large flexible manipulator with a parallel linkage drive 
are described. A linear controller using joint angle and 
strain measurements was designed to minimize a 
quadratic performance index with a prescribed stability 
margin. It is based on a simplified model that accounts for 
the constraints of the parallel linkage kinematically rather 
than through constraint forces. The results show 
substantial improvement over a simple P.D. joint control. 

INTRODUCTION 

A large, two link flexible manipulator designated 
RALF (Robotic Arm, Large and Flexible) is the subject of 
modeling and control research at Georgia Institute of j 
Technology. It is hydraulically actuated with the second j 
joint powered through a parallelogram linkage. This drive I 
linkage is representative of drives found in many large j 
articulated arms. It allows the substantial weight of the I 
actuators to be located near the base hence reducing the 
weight that must be supported and the inertia that must be 
moved. A parallelogram arrangement allows the drive for 
the second joint to carry some of the bending load on link 
1 as well. Most control researchers have avoided this 
practical configuration, especially when the links are 
flexible for the more tractable direct drive, serial link 
problem. The direct drive concept has not been employed 
for large articulated arms in earth’s gravity and may never 
be practical in that application. 

The difficulty of research with the parallelogram 
mechanism is the conceptual difficulty of modeling a 
system with nonlinear large motion dynamics, distributed 
flexibility, and constraints of dosed kinematic chains. One 
valuable contribution of the research described here is the 
determination of a simple yet adequate model for RALF 
and other arms of this type. The second contribution is 
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the analytical development and experimental testing of 
simple linear state space controllers. 

DYNAMIC MODELING 

Dynamic models for RALF have been developed and 
compared to experiment as reported in Lee, et.al. [1]. 
That model included an assumed modes approximation 
for the link deformation and algebraic constraint 
equations representing the closed chain topology of the 
parallel actuating link. A simpler model is used here as 
the result of two key assumptions. First, the kinematics of 
the deflection assumed allows no beam extension. Hence 
the distances between pin joints in the parallelogram 
remains constant and deflection of the lower or actuating 
link causes no rotation in the upper link. The thicker 
cross section of the upper link between the pins (points E 
and F in the schematic of Fig. 1) makes reasonable the 
second assumption: rigidity in that segment of the upper 
link. Consequently, the segment E-F remains parallel to 
the same line while deflections rotate the lower link. This 
is in sharp contrast to serial link arms. These facts will 
now be incorporated into the description of the arm’s 
motion. 

As proposed in Book [2], kinematics of serial flexible 
arms is readily described by 4x4 transformation matrices. 
In particular, consider the two link arm of Fig. 1. The 
transformation matrix between link-fixed coordinates and 
base coordinates is composed of joint transformation 
matrices A< and flexible link transformation coordinates 
Ei. The transformation to a point located a distance 1 2 
along the beam from the second joint is 

t 2 = a 1 e 1 a 2 e 2 . 0) 

The point on the second link is located at -r 2 in the link- 
fixed frame or at point r 2 in the base frame, where 


r, = T 2 h z . 


(2) I 


The constraints of the parallelogram mechanism on link 
two can be readily incorporated in the rotation matrix of 
E,. In general (for small deflections) 
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where 


is the time varying amplitude of the shape function, 

Ujj, vg and Wjj are the x, y, and z components, ! 

respectively, of the shape functions, 

*«j. *yij» and are the small rotations of the body- I 

fixed coordinate system at the point of interest, 

mi is the number of shape functions needed to represent 
the flexible kinematics to the degree of accuracy needed, 
and 1; is the distance to the point of interest along the links 
neutral axis, which is L*, the length of the link, when the 
point at r k is not on link i. 

In the special case at hand the rotations 0 xlj , 0 ylJ , and I 
9 Z \ j are zero as seen by link two. Only translations of the 
tip of link one are experienced by link two. 

It should be made clear that the model still accounts 
for rotations of the beams in the equations, but that the 
kinematic constraints prevent those rotations from 
propagating to link two in the ideal case of the joint 
rotational axis on the beam neutral axis. Comparing the 
drawing and the schematic of Fig. 1 will show a substantial 
offset in the laboratory hardware. This is an additional 
approximation in the dynamic model. 

Given the above description of the arm kinematics, 
8.4 the derivation of the dynamic equations of motion can 
proceed using Lagrange's equations substantially the same 
as described in Book [2]. The method shown here for two 
links can be extended to additional parallelogram 
actuated links. 

It is desirable to account for the cumulative 
compliance of the actuating link, pin joints, and hydraulic 
fluid in the actuator. Including a simple massless spring 
effectively accomplishes this. One end of the spring is 
attached to the second link and the spring compression is 
prescribed by the actuator displacement. Lagrange's 
equations can accommodate this model simply with an 
additional term in the system kinetic energy. The method 
employed here differs somewhat, however. The actuator 
force, instead of displacement, is chosen as the input. The 


force acting through a massless spring is instantaneously 
felt by the link and the spring is of no direct consequence. 
The actuator spring is of consequence in the selection of 
assumed mode shapes for the links, however, as described 
below. 

The transformation matrix E, contains deflection 
displacements and rotations as a function of position 1, 
along the link. The spatial dependence of these 
deflections, their shape, is theoretically required only to 
meet modest restrictions at the link boundaries in am 
infinite order model. A Finite element approach was used \ 
in this research to determine the shapes from detailed 
models of the link geometry and material properties. Ofi 
crucial importance to the accuracy of a low order model 
are the boundary conditions applied in deriving the] 
shapes. Equivalent springs were used to represent the| 
actuators for both links. Equivalent masses and inertias) 
were also placed at the end of each link, yielding boundary) 
conditions at 3 points on each link: at each end and wherei 
pinned in the middle. At these points on 

Link 1: pinned, spring, inertia 

Link 2: pinned, spring, mass 

The final nonlinear equations derived by Lagrangian on 
other equivalent method is of the form 

M(x) x+ H(x,x) x + K x * Q (4) 

where 

x is a vector containing the joint angles and the 
deflection amplitudes & ^ 

M is the inertia matrix 

! 

H(x r x) contains the nonlinear velocity dependent functions 
K is a spring constant matrix 
Q is a vector of actuator torques. 

CONTROL 

Using the model developed in above, an LQR 
(Linear Quadratic Regulator) controller was developed 
for RALF. The points about which the model was 
linearized are 6 1 = 0* and 0 2 - 90\ The LQR controller I 
utilizes strain feedback from strain gages mounted near 
the base of the links to control vibrations of the links. 

The linearized form of the equations of motion is: 

[M] [i) + [K] (x) = (Q) 
where x, M, K, and Q are given by: 
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Note that: 0 t 

= 0jo + 9 
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®2 ~ ®20 + 02 

where 0 IO * 0* and 820 = 90*. See Figure 24. 



For this LQR controller the following quadratic cost 
criteria was used to obtain a prescribed degree of stability: 
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with a, P, and R given by: 
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and u = -F(x - x r ) where x r is the reference state variable. 
Notice the large values in the [Q] matrix corresponding to 
the joint position variables. Two factors influenced these 
numbers. First, the system model was derived using 
inches as the unit of length. This resulted in very small 
numbers when [M]* 1 is formed. Secondly, the hydraulics 
actuators are very stiff and inherently have a high gain. 
The large numbers in the [P] matrix compensate for these 


factors. The small numbers in the [R] matrix also resulted 
because of the system of units used in deriving the model. 

Using a controller design software, CTRL-C, the 
LQR feedback gains were found as follows: 

p F2.8161E7 1.3518E4 3.1388E4 8.3383E3 2.8013E5 

U-5035E5 -4.4833E3 3.0015E7 1.0065E4 4.6735E4 

1138.4 4.483E4 248.226 1 

-12.9825 7.7616E4 268.2405J 

This yields a state space system of the form: 

X - (A - BF ) X + BX r 

It should be mentioned here that the feedback gains found 
by solving the LQR equations do not result in absolute 
values. What is important is the relative magnitude of the 
gains. When the controller was implemented, the gains 
were scaled to match the physical capabilities of the 
system. 

The controller for RALF was then implemented on a 
Microvax II computer with a sampling rate of 8- 
milliseconds. The language used is FORTRAN. All path | 
planning is calculated before movement starts. Thel 
following graphs show the results of the LQR controller 
compared to a controller that does not utilize strain 
feedback, ie., a controller using joint position feedback; 
only. The LQR regulator uses differentiation and filtering! 
to estimate all rates. 

Figure 3 is a plot of the strain in the lower link when; 
the manipulator is subjected to a step input. Figure 3-a.i 
shows the strain in the lower link when the controller usesi 
joint position feedback only. Figure 3-b. is a graph of thei 
strain in the lower link when subjected to the same inputs 
but using the LQR controller with strain feedback instead. 
As can be seen in Fig. 3-b., the vibration amplitude in the 
lower link is reduced much more rapidly when the LQR 
controller is used. 

Figure 4-a. shows the strain in the lower link when 
the controller uses joint position feedback only. Figure 4- 
b. is a graph of the strain in the lower link when subjected 
to the same input but using the LQR controller with strain 
feedback instead. Again the vibration amplitude is 
reduced much more quickly when the LQR controller 
incorporating strain feedback is used. 

Figure 5-a. shows the strain in the lower link in 
response to a disturbance to the manipulator’s structure. 
In this case, the manipulator’s position is being 
maintained by the controller that uses joint position 
feedback only. Figure 5-b. shows a graph of the strain in 
the lower link when subjected to the same disturbance 
when using the LQR controller to maintain the 
manipulator's position. Much better disturbance rejection 
is seen in Fig. 5-b. than in Fig. 5-a. 

SUMMARY AND FUTURE WORK 

It is seen from these experiments that a suitable 
controller utilizing strain information from the links can 
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successfully damp out the vibration in the manipulator. 
The LQR controller is a good example of these. Since the 
structure’s dynamics are non-linear, a better controller 
might be one that incorporates some nonlinearities and 
adapts to changes in configuration. Work on this aspect is 
underway. 
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Figure 1. Robotic Arm Large and Flexible (RALF); 
Actual and Idealized. 

\ * ^2 



V 


pKd Y -SOOm Sac 3. 5 

Figure 3a. Lower Link Strain for Joint P.D. Control, 
Step Input. 



Figure 3b. Lower Link Strain for Strain Feedback 
LQR, Step Input. 
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Figure 4a. Lower Link Strain for Joint P.D. Control, 
Step Input. 


Figure 2. Variables in RALF Model 
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Figure 4b. Lower Link Strain for Strain Feedback ; 
LQR, Step Input. 



Figure 5a. Lower Link Strain for Joint P.D. Control, 
Impulse Disturbance. 
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Figure 5b. Lower Link Strain for Strain Feedback 
LQR, Impulse Disturbance. 
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ABSTRACT 

A robust adaptive control is derived by signal-synthesis 
methods for a fight, flexible two degree-of-firecdom manipulator. The 
controller for each joint is decentralized, using measurements of one 
Joint's position ns well as one link's strain. The coupling to other 
dynamics is treated as a bounded uncertainty in the model. A stability 
proof has been developed and is outlined. Performance of the advanced 
co ntroll e r is compared to a linear Quadratic Regulator (LQR) and to 
an independent joint control. Both simulations and experiments are 
presented. The cases of payload variations are considered at this point 

L INTRODUCTION 

The industrial robotic arm has been for rigidity by 

hnpfcmeating short fink lengths and heavy steel construction in order to 
achieve position a l accuracy and stability of the robot's movement The 
resulting disadvantages include slow motion speed, low payload to 
weight ratio rod high power consumption. To overcome these issues, a 
robotic arm with a fight-weight structure poses an important solution for 
the d esi g ner of the next generation of robots. The main problem with 
fight-weight structures is m the resulting flexible vibrations which are 
naturally e xcited as the arm is commanded to move or is disturbed. An 
effective control is one key to moving the flexible arm with high-speed 
motion and fort vibration settling time [L2]. 1 

In order to demonstrate the control system of a flexible arm, a 1 
large flexible manipulator arm, designated RALF (Robotic Arm, Large 
rod Flexible), is nsed in the experiment The robotic system with the 
independent jaiat FD (Proportional-Derivative) controller, which is 
proven to be tfabie via the Lyapunov criterion, leads to the development 
of an advanced control algorithm using a decentralized scheme. In other 
words, each flexile fink cm be considered as a subsystem of the overall 
system. Under consideration of the uncertainty for interconnected terms ] 
of each subsystem, the dynamic system of the manipulator motion is 
illustrated to be bounded by the reference model, which is rh ourn to be 
stable. The posable magnitude of the uncertainty is presumed known, 
making the tarisrical information far » approach 

(3). Thns, the feedback systems are also insensitive to other 
rocertahaties such as friction, measurement error, and etc 

Certain matching conditions are assumed to guarantee that the 
uncertainty vector does not influence the dynamics more than the 
control input does [4J. The signal-synthesis adaptation approach 
here results in a robust design that reduces the burden of on-line 
computation, while an auxiliary input with the update action should have I 
foster c o nv e rge n ce rate and smaller steady-state er ror. 


\ Simulations and experiments are carried out to compare this 

controller to the independent joint PD controller and an LQR 
controller. The sensitivity of the control performance to variations in 
payload ranging from 0% to 40% of the arm structure is considered. 

O. DYNAMIC MODELING AND INDEPENDENT JOINT 
CONTROLLER 

To specify the robot controller, the dynamical equations of 
motion need to be developed for the system [5]. a rigid arm will 
have one generalized coordinate per joint, but a flexible arm may have 
many. Transformations representing the joint coordinates and link 
deflection can be used to represent the position r< of a point. The 
velocity can be related to the coordinate derivatives as [7] 


\ - 


•Vi 


( 2 . 1 ) 


r is the velocity vector in the Carteasian coordinates, 

Jj is the 3xL matrix of Jacobian, 

X| represents the time derivative vector including i joints, 
say, qj, q^.-.q,, and Lf-i time dependent flexible coordinates. 

The kinetic energy of the n-tink flexible arm is then: 
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It is mentioned that the inertia matrix M, a function of 
position, is symmetric and positive definite. The kinetic energy of rigid 
robotic arms have the same structure as (23a) 

Without the effect of gravity, the potential energy of the 
flexible arm which includes the elastic joint and strain energy is 
expressed as 


PE - | X K X, 


(2-3) 


where _ 

X « X - Xo> Xo is the unstretched coonfinate at the "home" 


K is the stiffness matrix, which has the corresponding value as 
described in Ref. [7J. 

By applying the Lagrangian formula, the equation of motion in 
the Matrix-Vector form ts: 


M MX + HX + KX 

where 


Q . 


(2.4) 


Q is the generalized force, which acts on the joint q only. 

H re presents nonlinear term* and (M - 2H) is skew symmetric. 

The form has also been found in the rigid arms without the 


! I 


Hence, a multi-link flexible arm with independent joint 
controllers will be stable. The case of a rigid-link manipulator has been 
illustrated by Asada and Slorine [5]. The frequency domain approach 
has been taken by Book [1] for flexible arms, and physically, the 
feedback system effectively equips each joint with an equivalent rotary 
spring and damper. The input torque then has the following form: 


K p1 q 1 + K d1 q 1 


(2.5) 


where 


Kpj and Rdi are positive constants, 

qj * q^ - . q^o is the reference path and assumed to be 

qj - qj. 


Because the torque acts only on each joint, the following equality exists 

( 2 . 6 ) 
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Choose a Lyapunov candidate V associated with the total energy of the 
feedback system: 


V(X,X,q) - kx T MX + X T HX + qV q]» 


( 2 . 7 ) 


where 


K p - dlag [K pi l 


Differentiating V with respect to time gives 

X < 

P 


• .T - .T 1 .T. . *T - 

V - q K q + X MX + ± X MX + X KX 

P Z 


(2.8a) 


q T K q + X T (H + KX) + j X T MX 


By substituting (25), (16), (2.4) and the skew-symmetry of (M-2H) into 
above, 
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V - q T K p q + X(Q - HX) ♦ \ X T HX 

- q T K p q + X T Q ♦ \ X T (H - 2H)X 

- q* K p q ♦ qk 

- - q Kq q £ 0 

kj) -diagftjj is a positive matrix. 

Therefore, the system with a local joint PD controller leads to 
the development of an advanced control algorithm using a 
decen tr alized scheme which is restrictive on information transfer from 

one group of sensors and actuators to others. 

HL DECENTRALIZED ADAPTIVE CONTROL 

Without toss of generality, the system of a two-degree-of- 
; freedom flexible manipulator with the effect of gravity is considered 
i from the control viewpoint; Le, n-2. To combine with friction and other 
disturbances that are treated as uncer t a inti es R(X^), the equations of 
j motion are, then, rewritten as follows: 

i 

i M(X)X + H(X,X)X + KX + G(X) + R(X,X) - Q (3.1) 

The actuator dynamics is ignored. 

Since the inertia matrix, M(X), is square, symmetric and 
positive finite, one can always find a constant matrix £ such that the 
of fi corresponding to the coopting subsystem are zero and 


(3.2) 


i I 


Ml > K*(x) - ri 

! I* | is an induced norm. 

Equation (3.1) can be rearranged as 

X - -H _1 [HX + KX + G + R1+M + (M' 1 - 4)Q (3.3) 

With i-L2,letz i *(x b xJ T and equation (33) is efivided into two 
equations for two subsystems, 

Z 1 - A 1 Z 1 ♦ b |U| + F^Z) ♦ f^ZJu, (3.4) 

where U| - T* m (2 £); £| (Z)uj * the coupling terms of (M 1 -0)Q for 
subsystem i. A| is a co n*f»ni matrix which represents the linear time 
invariant part of -M“ l K, 


*<•[•» u 


(3.5) 


Fj(Z) - b i D^Z) 
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f^Z) - b 1 E^Z) 

where D| and Ej have the corresponding dimensions; |e^ | < 1 from 

(*2). 
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while P| (Z) represents the rest of -M"* K and the no n l ine a r terms of 
-M* 1 [H+R+O]. bn, then , becomes a vector form with zero elements on 
the upper half. 

It is — that Fj and fj are bounded and hate the following 
properties: 
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- i 


These conditions, called the matching conditions [8], guarantee that the 
uncertainty does not influence the dynamics more than the control input 
does [4]. The one degree-of* freedom system, has been illustrated by the 
previous works [9] , and for the two degree-of-freedom flexible arm, 
each link is considered as a subsystem. 

The objective of model reference adaptive control is to 
eliminate the state error between the plant and the reference model so 
that the behavior of the plant follows the modeL Consider the reference 
model first. 
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Tj Is the reference Input, 


and let 
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A .1 - A 1 + b , K z1 

b .i - b i Si 


(3.7b) 


where and are constant matrices with the corresponding 
ona. 

Also, A^, which is a stable matrix, satisfies the Lyapunov 


A .r p i * p i A .i 


- L. 


(3.7c) 


where F| and L; are positive definite and symmetric mat ri ces. 

The signal-synthesis method [10] implemented here seeks to 
control the system by adjusting the input which is as described in the 
fallowing equation 


"l “ K z1 Z 1 + K b1 r f + ^< e 1> 


(3.8) 


where e$ * x^ - z^ is referred to as the state error and the function ^ is 
the control input to compensate the system uncertainty. Thus, let ^ be 
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(3.9) 


^(Z.e^^), when jb^P^J < « 1 


where 6jis a prescribed positive constant and fi i is a positive constant to 
be specified subsequently. ( 

As a result, the error dynamics of the subsystem is derived 
from the difference between equation (3.4) and (3.7) along with (33) 

and (34): | 


z .i - z i • Vi - WV* < 3 - 10# > 


where 


*i m °1 + E 1 (K zi + Si r 1 + V 


(3.10b) 


Given the boundedness of the state variable z* and the 
reference input equation (3.10b) with (3.9) has the following 
inequality: 


l*i I s 'i ( z x P r r () 


(3.11a) 


where 

. />i * + iK^rJ * (3.11b) 

-j This definition involving p x on both sides of the equation is valid; Le., 
! (3.11) can be solved, since (32) is satisfied. Therefore, we have 

j v {1 'l E il , * ll|D il + l E i l(|K zi z il + l K bi r i ,,] {3 - 12) 

To specify that the error dynamics (3.10) is uniformly bounded, 
the approach is also based on the Lyapunov criterion and similar to ref. 


[8]. Given a candidate 
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Furthermore, to improve the convergence rate of equation 

■ 


! (3.10), an auxiliary input Wj(t) is introduced and applied to the input 

| m (33) (7]. This input is apparently an integral action and 


| « 1 (t) - - a^d) + Sj 1 b 1 T P i « i , (3.14) 
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s 1 >0 

Note that J L. represents the minimum eigenvalue. 

The error dynamics of the total system can be proven stable by 
summing the individual Lyapunov function (3.13) [7]. The block diagram 
| of the decentralized adaptive control is shows in Figure L 

IV. SIMULATIONS AND EXPERIMENTS 

The following section will demonstrate the results obtained 
from the analytical works using RALF, which is in the Flexible 
Automation Laboratory at Georgia Tech. The arm is constructed of two 
ten foot links and two rotary joints. The second joint is actuated through 
I a parallelogram mechanism by a hydraulic cylinder at the base [11]. A 
simple yet adequate dynamical model for RALF has been established, 
wherein the parallel link is described simply as a spring [7]* 

| A MkroVax U running the VMS operating system is used to 

! provide high speed calculation for real-time control and data- 
| acquisition. The resolution of D/A and A/D is 12 bits/10 Volts, and the 

sampling time is 8 ms. For the ™»ti*l measurement, the bandwidth erf 
| both hydraulic motors is above 45 Hz and the lowest frequencies erf the 
| RALF are 5.69 Hz and 9.12 Hz. The parallel link's lowest frequency is 
about 30 Hz, which cannot be controlled. A linear variable differential 
transformer (LVDT) is the position transducer mounted on the 
j hydraulic piston rod, so that the noncollocation problem existing in the 
i feedback control of flexible structures may be avoided. The link 

J deflection is obtained by utilizing a strain gage mounted near the joint. 

| One flexible mode is adopted for each link in this work. 

The first joint position of 35* and the second joint position of 
I 109* are set to be the 'home* position for RALF. A linearized 
dynamical equation is used to derive the constant gains Kzj and Kb, in 
i (3.7) and (3.8), while the payload is not considered at this moment [11]. 
Kzj 0"L2) are: 


OHIGIM/u. j z AiiiI is 
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K , • [-2.8E7 -1.35E4 -2.8E5 -1.14E3] , (4.1) 
zt 

K „ - [-3.0E7 -1.01E4 -7.76E4 -2.68E2] , 

Z2 

■MtKbj-1. 
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Figure 4dL Strain Response of Lover Link (Decentralized, 
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Abstract 

A robust tracking controller for a one link flexible arm based on a model reference 
adaptive control approach is proposed. In order to satisfy the model matching conditions, the 
reference model is chosen to be the optimally controlled linearized model of the system. The 
resulting controller overcomes the fundamental limitation in previously published research on 
direct adaptive control of flexible robots which required additional actuators solely to control 
the flexible degrees of freedom. The nominal trajectory is commanded by means of a 
tracking control. Simulation results for the prototype in the laboratory show improvements 
obtained with the outer adaptive feedback loop compared to a pure optimal regulator 
control. Robustness is tested by varying the payload mass. 
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Introduction 


Lightweight arms are a challenging research topic with potential to improve over today’s 
robot performance. Control is one key to effective use of lighter arms , 1 - 2 but it is limited by 
uncertainties in the arm’s behavior and in the environment. The main problem with light- 
weight structures is the flexible vibrations which are naturally excited as the arm is 
commanded to move . 3 

The first step in designing a control system consists of developing a dynamic model for the 
flexible arm. A general dynamic modeling technique was established by Book , 4 based on a 
recursive Lagrangian-assumed modes method. If one is interested in the regulator control 
problem requiring that the arm reach a pre-specified nominal state with satisfactory response, 
the approach of linearizing the dynamic equations by assuming small motions around the 
nominal state and neglecting terms of higher order, proves effective. An optimal control for a 
one-link flexible arm was experimentally tested by Hastings and Book . 5 Also, experimental 
results with linear models were reported by Cannon and Schmitz 6 , by Fukuda 7 , by Sakawa et 
al. 8 , and by Chalhoub and Ulsoy . 9 Frequency domain techniques, instead, were adopted by 
Book and Majette 10 and recently revisited by Ower and Van de Vegte . 11 

On the other hand, if one is concerned with controlling the arm while it is moving along a 
pre-defined path with given velocity and acceleration of the joint variables, the technique of 
linearizing the system is likely to fail. Furthermore, linearization around a sequence of 
nominal states, as done by Sunada and Dubowski 12 for instance, seems expensive 
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computationally and not necessarily very robust when applied to the overall nonlinear 
dynamics. 

This paper describes research on control for a one link flexible arm moving along a pre- 
defined trajectories. The resulting controller overcomes the fundamental limitation in 
previously published research on direct adaptive control of flexible robots which required 
additional actuators solely to control the flexible degrees of freedom. Previous efforts aimed 
at designing tracking controllers for flexible arms have been produced by Singh and Schy 13 
with a nonlinear inversion control, and by Davis and Hirschorn 14 with a linear control. They 
have both taken advantage, however, of additional active tip actuators. A nonlinear joint 
tracking controller has been devised by DeLuca and Siciliano 15 . A singular perturbation 
approach has been pursued, instead, by Siciliano and Book. 16 

The approach adopted here is based on Model Reference Adaptive Control (MRAC), 17 
as recently proposed by Siciliano et al. 18 In order to assure the satisfaction of the so-called 
model matching conditions, the reference model is chosen as the linearized system (2nd order 
terms neglected) as optimally controlled. Integral type adaptive actions guarantee the stability 
of the overall system, as is proved via the Lyapunov direct method. However, since the 
reference model turns out not to be decoupled, the reference trajectory is forced on the 
system by means of a tracking controller. 19 A direct adaptive controller for a linear model of 
a flexible arm was also designed by Meldrum and Balas 20 , but stability was guaranteed only 
for a special class of trajectories. An indirect adaptive control conversely, with dynamic 
parameter identification was proposed by Canudas, De Wit and Van den Bossche. 21 
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A case study based on a laboratory prototype, whose dynamic model is described in 
Hastings and Book 22 shows that the control performs well when tracking a fast trajectory. The 
whole nonlinear system is considered for simulation purposes. Moreover, the control proves 
robust to parameter variations such as payload changes. 

It must be mentioned that full state availability is assumed for control synthesis. While 
the state variables representing deflection can be obtained from strain gage measurements, 5 
their derivatives need to be reconstructed by means of an observer. 23 

Problem Formulation 

Nonlinear equations of motion for a flexible arm can be derived using the Lagrangian 
approach. 4 The deflection of the elastic members is represented as a linear combination of 
admissible functions multiplied by time dependent generalized coordinates. 24 The flexible 
motion of a link is then described by 

n 

u(77, t) 0.(77) 6. (t) (1) 

i=l 

where the 0 ^ 77 ) are assumed in this paper to be eigenfunctions of a clamped-free beam, 6;(t) 
are the generalized coordinates, and 77 is any point along the undeformed link (see Fig. 1). 
Furthermore, assuming that the amplitudes of the higher modes of the flexible link are very 
small compared to the lower modes, n = 2 will be accurate enough to describe the flexible 
motion. 22 * 25 
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The derivation of the dynamic equations for the one link arm follows then as in Book 4 


and Siciliano and Book 16 i.e. (dropping the explicit reference to time dependence) 


M(M) 


' 8 ' 


' fl ‘ 


' 0 ' 


u 

. 8 . 

+ 

. f 2 . 

+ 

. K6 . 

= 

_ 0 . 


( 2 ) 


where 8 is the joint angle. 

M is the inertia matrix. 

f x and f 2 are vectors containing nonlinear dynamic terms 
(interactions of angular rates and deflections). 

K is the effective spring matrix, 
u is the net input torque. 

Notice that in the model no actuator dynamics is considered, and no friction at the joints nor 
in the structural vibrations is explicitly included. Define the full state vector 


XT = [xp t , x vT ] and x vT = [ 8 , S 7 ] = xp t 


(3) 


The dynamic model of the flexible arm of Fig. 1 can be expressed in state variable form as 


d_ 

dt 


xP 

xv 


0 

Ai(xP) 


I 

A 2 (xP,xV) 



’ xP ' 


' 0 



+ 



. * v . 


. B 2 (xP) . 


u 


(4) 



X = A(X)X + b ( X ) u 


(5) 


where 


Aj(xP)xP = M 


0 

K5 


A2(xP,x v )x v 



82 (xP) = M 


1 

0 


At this point it becomes clear why the tracking control problem is difficult. If the goal is 
just to require that the arm reaches a pre-specified nominal state, linearizing (5) around the 
nominal state leads naturally to an optimal regulator in which one can eventually specify the 
closed loop poles of the linearized system with an arbitrary degree of stability. However, if 
one desires to control the arm while it moves along a pre-defined trajectory, in terms of joint 
angle rates and accelerations, a different approach must be sought, rather than trying to 
linearize (5) around a sequence of nominal states. 

In order to obtain good trajectory tracking and steady-state accuracy, a direct MRAC 
approach 17 is pursued in the following. The basic idea of this approach is to define a linear 
time-invariant reference model and directly synthesize a controller that assures that the error 
between the states of the system and those of the model tends to zero. To this purpose let 


X m = A m X m + b m u m 


(6a) 


6 


0 


I 


0 


(6b) 


Am = b m - 

. A io A20 J bo 

be a linear time-invariant reference model of the same dimension as the system described by 
eqs. (5). 

As in the work on MRAC for rigid manipulators, 26 - 27 it would seem appropriate to select 
a decoupled model for (6), i.e. A 10 = diag(a n a 12 a 13 ), a u < 0, A 20 = diag(a 21 a^ a^), a 2i < 0. 
However the model matching conditions which are the basis of an MRAC approach 28 cannot 
be satisfied independent from the particular values of A, A^ b, b m . This can be confirmed by 
observing that the system described in (5) does not have as many control inputs as nontrivial 
state variables ( 6 , S l5 S 2 ), i.e. the lower block of vector b 0 in (6b) is not a square block (a row 
vector in this case). 

In the particular case of the system in (-5), however, the nonlinear terms do not play a 
dominant role, thus it appears adequate to choose a reference model on the basis of the 
linearized model of the system (2nd order terms neglected) as optimally controlled; this 
approach will be outlined in the next section. 

Control Law Development 

Following the basic MRAC scheme in Landau 17 a control for the overall system (5) - (6) 
is proposed in the form 

U = Uj + u 2 

u 2 = -AK x T X + AK u u m 


Ul = -K TX + K u u m 
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(7a) 

(7b) 



where u x is a linear model following control and u 2 represents the adaptive control which is 
devoted to assuring the stability of the whole system. Under the action of control (7), the 
system (5) becomes 


X = A S (X)X + b s (X)u m (8a) 

Aj = A- b(K x T + AK X T ), b s = b(K„ + AK U ) . (8b) 

Let then 

e = X m - X (9) 

be the error between the model and system states. On reduction of (6) and (8), the error 
dynamics are found to be 

e = A m e + (A,„ - A*)X + (b m - b s )u m (10) 

In order to satisfy the model matching conditions, the following should hold: 28 

A m = A-bK x T b m = bK u (11) 
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where A and b are the linearized forms of A and b, respectively. Assuming that the pair (A,b) 
is stabilizable, K X T can be designed by means of optimal control techniques for the linearized 
system in (A,b). K u is chosen equal to 1 for simplicity. Substituting (8b) and (11) into (10) 
gives 


e = A m e + [A A-AbKJ" + bAK^x + [AbK u -bAK u ]u n 


( 12 ) 


where A - A = AA 


and b - b = Ab 


(13a) 

(13b) 


express the difference between the actual system and its linearized parts. In order to 
guarantee the stability of the overall system, a candidate Lyapunov function is 


V = eTPe + tr[(A m - A s ) T F a - 1 (A m - A,)] 
+ tr[(b m - b s )TF„-Kb m - b s )] 


(14) 


where P, F a , F b are positive definite matrices. The derivative of V including (12) yields 


V = eT(A m TP + PAJe + 2tr[(AA-AbK u T +bAK x T ) T (PeX T -F a - 1 A s )] 
+ 2tr[(AbK u -bAK u )T(Peu m -F b - 1 b s )] 


(15) 
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Setting, as is usual, 


A m TP + PA m = -H ^ 

where H is a positive definite matrix, and assuming that the rate of the adjustable gains is 
larger than that of the system, AK X , AKy > > A, b, leads to 

V = -eTHe + 2tr[(AA-AbK u T + bAK x T ) T (PeX T + F a - 1 bAK x T )] 

+ 2tr[(AbK u -bAK u ) T (Peu m -F 5 - 1 bAK u )] (17) 

At this point the choice of 


AK t = -(b T F a ' 1 b)* 1 b T PeX T , 

AK x T | t=0 = AK xo T ( 18a ) 

AK„ = (b T F b - 1 b)- 1 b T Peu m , 

AK u | t=0 = AK u0 ( 18b ) 

results in cancellation of the last two terms in (17), and assures that V is negative definite, thus 
guaranteeing that e -*■ 0 (X -*• X m ). 

The only problem now remaining is to force the system to track a desired trajectory. This 
point has been addressed by Meldrum and Balas 20 but, even with an equal number of controls 
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and output variables, only a sinusoidal reference trajectory could be commanded of the rigid 
body motion. An inverse model technique of the type proposed in Balestrino et al. 26 cannot 
be adopted since the model (6), satisfying (11), turns out not to be decoupled. However, the 
state-space design existing in the reference model (6) appears to provide a possible way out of 
this dilemma by specifying the development of systematic design procedures for both the 
optimal regulator and the tracking problems. 19 

Tracking Controller 

The tracking problem was initially conceived in order to extend state-space regulator 
methods to problems having external command inputs. Therefore, consider an output form 

Y = C X m (19) 

where Y is the output to be tracked. 

C is a constant matrix. 

Meanwhile, a control system for the reference model (6) and (19) must be synthesized such 
that in the steady-state condition, the output Y becomes equal to some arbitrary desired 
constant reference output Y r (t) = Y r . In order to pursue this goal, the integral error W 
between the reference and the actual outputs is defined as follows : 
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W = Y r - Y or W = J*(Y r -Y)dt ( 20 ) 

and the tracking control law can thus be written as 

u„ = -K.X. - K,W < 21 ) 

where K t are the proportional and the integral gains respectively. Adjoining (20) and (21) 

to (6), gives 

Z = A*Z + B 0 Y r ( 22 > 

where Z T = [X m T , W] 


A 0 


Atirbrn^m 
-C 0 


Bo = 


0 

I 


It is claimed that the dynamic system (22) is asymptotically stable, if K| is chosen 
appropriately. Then, in the steady state, 


lim Z * Zoo = 

t-*» 


X« 

Wco 


-C 0 I 


Yr 


(23) 


where the inverse matrix exists due to the asymptotical stability. Clearly, the desired zero 
error between Y and Y r is also obtained in the steady state, i.e. JiS Y(t) = Y r or [is W(t) = 0. 
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Now, the objective is to find the gains K m and Kj. Define 


AX m = X m - X® AW = W-W <0 Au m = u m - u® (24) 

where u® = -K m X® - K[W® 

The transient response is then governed by the set of differential equations 


d 

dt 


’ AX m ' 


A m 0 


AX m 


bm 


= 




+ 


. AW 


. -C 0 . 


AW 


. 0 


AUn 


(25) 


An LQR design is utilized to minimize the performance functional for (25) 


(UxJ 


AW] Q 


AX m 

AW 


+ RAu m ) dt 


(26) 


This results in 


K® = R' 1 b m S 11 
= R-ibmSn 


where S = 


S 11 s 12 ‘ 
. s 12 s 22 . 


> 0 is the solution of the Riccati equation. 


(27a) 

(27b) 


In summary, since the constant matrix C is determined by the output Y, one needs at 
least as many inputs as the number of outputs to be tracked and needs the dynamical system 
(25) to be controllable. 19 Therefore, K m and Kj are simultaneously derived as in (27). With 
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only one input, for example, the dynamical system (25) in the case of a one-link flexible arm 
may be uncontrollable when the joint velocity is to tracked as is shown in the following 
example. This may result in a singular solution for the Riccati equation (27). Finally, the total 
control problem becomes one of choosing the feedback constant gains K*, K u , along with the 
adaptive gains AK X , AK U for system stability, and K„, as well as the integral gain K r for the 
desired reference tracking. In other words, u is composed of (7) and (21). The block diagram 
of the total system is shown in Fig. 2. 

The Case Study 

In the following a case study is developed for the one link flexible arm existing in the 
Flexible Automation Laboratory at Georgia Tech, whose specification is fully described in 
Appendix A. 

As far as the joint angle trajectory is concerned, the arm is required to move from 6 { = 0 
deg. to df = 90 deg. in 2 seconds, following a standard trapezoidal velocity profile with 
maximum velocity 0 = 60 deg./sec. The constant feedback gain resulting is K X T = [65.27 
-176.13 -2937.23 27.27 -7.50 -67.27] and K u = 1. AK X T and AK U (18) have been chosen with F a 
= 21, F„ = 0.005, and H = I in (16) such that the system under adaptive control is guaranteed 
to be stable. AK xo T and AK uo are null here. An LQR design with Q = 21 and R = 1, which is 
used to derive the tracking controller, results in K m T = [0.0 -0.635 -8.591 0.06 -0.056 0.046], Ki 
= 0.031 for the joint angular velocity to be tracked (Fig. 4-7) (i.e. CT = [00 0 1 0 0]). For 
the joint angular position to be tracked (Fig. 8-11) (i.e. C 1- = [1 0 0 0 0 0]), the tracking 
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controller is Km 1- = [0.616 -0.793 -10.004 0.1335 -0.034 0.05], Kj = 1.414. For the end point 
position to be tracked (Fig. 12 - 15) (i.e. C 1 = [4. 2.02 -1.365 0 0 0]), K m T and Kj become [2.41 
-1.27 -14.32 0.396 0.05 0.0058] and 1.4142. Also notice that the dynamic system which is 
linearized around zero states from (4) is used to derive the optimal (constant) gains K x . This 
results in unstable responses for the constant (nonadaptive) feedback control system, when 
the arm travels at high velocity. 

Different sets of simulations have been carried out, one with the above design 
parameters, and another one just with the constant feedback gains K X T and K u , without any 
outer adaptive control. In order to analyze the control performance the whole nonlinear 
model has been simulated for the system (5) in both cases. A sampling rate of .1 ms has been 
adopted. Furthermore, the robustness of the system control to parameter variations has been 
tested by doubling the payload mass, without changing the constant control gains. Figs. 4 
through 15 illustrate the results obtained. It can be recognized that the adaptive control 
performs better than the simple optimal control, as it results in better tracking accuracy. 

First consider the case (Fig. 4-7) of joint velocity tracking. Fig. 4 shows the joint position 
response with and without adaptive control and corresponding reference input. Fig. 5 shows 
the joint velocity. Note better tracking occurs with adaptation but at the expense of some 
oscillations as gains adapt. Fig. 6 shows differences in the end point position error with 
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respect to the reference signal. Fig. 7 shows the joint torque. It should be pointed out that the 
dynamical system (25) does not satisfy the criteria of controllability. Therefore, the solution 
of the Riccati equation is singular, which causes undesirable response with inaccurate 
tracking and oscillations. However, such problems do not arise for joint position and end 
point tracking. 

When the system is used to track a joint position command (Fig. 8-11), the nonadaptive 
control is unstable due to uncompensated nonlinearities and thus not plotted. The joint 
position response of the adaptive control is shown in Fig. 8 with the reference joint position 
command and responses for a nominal payload as well as twice the payload used in the 
design. The low steady-state error and the low effect of payload change illustrate the robust 
properties of the controller. Joint velocity, end point position error and control torques are 
illustrated in Fig. 9-11. 

Another quantity tracked in this analysis is the end point position. Figs. 12 - 15 show the 
time responses for this simulation. The results are almost identical to the above joint position 
case, except that the end point position error is comparatively small during this control 
process. Note that this requires that the reference model predict the end point position. 

Conclusions 

A model reference adaptive control has been presented for a one link flexible arm which 
is based on the preliminary results obtained in Siciliano et al. 18 In order to comply with the 
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model matching conditions, the reference model has been set up to be the linearized arm 
model of the system as optimally controlled. Since the resulting reference model is not 
decoupled, the desired joint angle trajectory is commanded through a tracking controller 
proceeding the overall system. Full state availability has been supposed for control synthesis. 
The extension of this work to the use of an observer has been initiated and described in Yuan 
and Book . 23 

A case study has been developed for a prototype in the laboratory. Simulation results 
have shown the advantage of using an outer adaptive feedback control with respect to the 
pure optimal control and the robustness of the system control to payload variations. 
Furthermore, for the tracking controller, only the joint velocity command is not 
recommended based on the results of this work. 

It must be emphasized, however, that for multiple link flexible manipulators the results 
obtained in this paper appear only partially satisfactory. In the case of more degrees of 
freedom, the nonlinear coupling terms in the joint variables (which are not present in the one 
link case) may become dominant, particularly at high speed, and control performance is likely 
to be derated. 

This point, along with the problem of state reconstruction, or eventually considering 
output feedback, constitute two challenging research issues needing additional investigation. 


17 



Acknowledgements 


The authors would like to acknowledge that this material is based in part on work 
supported by the Computer Integrated Manufacturing Systems Program at Georgia Tech, and 
by the NATO Science Programme (Special Panel on Sensory Systems for Robotic Control) 
under grant no. 687/86. 


References 


1. W. J. Book, O. Maizza-Neto and D. E. Whitney, "Feedback control of two beam, two 
joint systems with distributed flexibility," ASME J. Dvn. Svst.. Measur. Contr. . 97 (4), 
424-431 (1975). 

2. M. J. Balas, "Feedback control of flexible systems," IEEE Trans. Automat. Contr.. AC- 
23, (4), 673-679, (1978). 

3. A. Truckenbrodt, "Modelling and control of flexible manipulator structures," 
Proceedings of the 4th CISM-IFToMM Symposium on Theory and Practice of Robots 
and Manipulators. A. Morecki, G. Bianchi and K. Kedzior (Eds.), Zaborow, Poland, 
Sept. 8-12, 1981, pp. 90-101. 

4. W. J. Book, "Recursive Lagrangian dynamics of flexible manipulator arms," Int. J. of 
Robotics Research. 3 (3), 87-101 (1984). 

5. G. G. Hastings and W. J. Book, "Experiments in optimal control of a flexible arm," 
Proceedings of the American Control Conference . Boston, MA. June 10-12, 1985, pp. 
728-729. 

6. R. H. Cannon, Jr. and E. Schmitz, "Initial experiments on the end-point control of a 
flexible one-link robot," Int. J. Robotics Research . 3(3), 62-75 (1984). 

7. T. Fukuda, "Flexibility control of elastic robotic arms," J. Robotic Systems. 2(1), 73-88 
(1985). 

8. Y. Sakawa, R. Matsumo and S. Fukushima, "Modeling and feedback control of a 
flexible arm," J. Robotic Systems . 2(4), 453-472 (1985). 


18 


9. 


N. G. Chalhoub and A. G. Ulsoy, "Control of a flexible robot arm: experimental and 
theoretical results," ASME J. Dvn. Svst. Meas. Contr, . 109 (4), 299-309 (1987). 


10. W. J. Book and M. Majette, "Controller design for flexible, distributed parameter 
mechanical arms via combined state space and frequency domain techniques," ASM E 
J. Dvn. Svst. Meas. Contr,. 105(4), 245-254 (1983). 

11. J. C. Ower and J. Van de Vegte, "Classical control design for a flexible manipulator: 
modeling and control system design," IEEE J, Robotics. Automation. RA-3 (5), 485- 
489, (1987). 

12. W. H. Sunada and S. Dubowski, "On the dynamics analysis and behavior of industrial 
robotic manipulators with elastic members," ASME J. Dyn, Svst.. Me as.. Contr.. 
105(1), 42-51 (1983). 

13. S. N. Singh and A. A. Schy, "Control of elastic robotic systems by nonlinear inversion 
and modal damping," ASME J. Dyn. Svst.. Meas.. Contr,. 108 (3), 180-189, (1985). 

14. J. H. Davis and R. M. Hirschorn, 'Tracking Control of a Flexible Robot Link," IEEE 
Trans. Automat. Contr. AC-33 (3), 2 38-248 (1988). 

15. A. De Luca and B. Siciliano, "Joint-based control of a nonlinear model of a flexible 
arm," Proceedings of the American Control Conference. Atlanta, GA, June 15-17, 
1988, pp. 935-940. 

16. B. Siciliano and W. J. Book, "A singular perturbation approach to control of light- 
weight flexible manipulators," Int. J. Robotics Research. 7(4), 79-90, (1988). 

17. Y. D. Landau, Adaptive Control: The Model Reference Approach. Marcel Dekker, 
Inc., NY, 1979. 

18. B. Siciliano, B. S. Yuan and W. J. Book, "Model reference adaptive control of a one 
link flexible arm," Proceedings of the 25th IEEE Conf. on Decision and Control . 
Athens, Greece, Dec. 10-12, 1986, pp. 91-95. 

19. P.C. Young and J. C. Willems, "An approach to the linear multivariable 
servomechanism problem," Int. J. Control. 15 (5), 961-979 (1972). 

20. D. R. Meldrum and M. J. Balas, "Direct adaptive control of a remote manipulator 
arm," Robotics and Manufacturing Automation (Proceedings of the ASME Winter 
Annual Meeting), H. Donath and M. Leu (Eds), Miami, FL, Nov. 17-22, 1985, pp. 1 15- 
120 . 


19 


21 . 


C. Canudas De Wit and Van den Bossche, "Adaptive control of a flexible arm with 
explicit estimation of the payload mass and friction," Preprints of the 
IFAC/IFIP/IMACS Int. Symposium on Theory of Robots . P. Kopacek, I. Troch and 
K. Desoyer (Eds)., Vienna, Austria, Dec. 3-5, 1985, pp. 315-320. 

22. G. G. Hastings and W. J. Book, "A linear dynamic model for flexible robotic 
manipulators," IEEE Control Systems Magazine. 7, (1), 61-64 (1987). 

23. B. S. Yuan and W. J. Book, "A robust scheme for direct adaptive control of flexible 
arms," in Modeling and Control of Robotic Manipulators and Manufacturing 
Processes. R. Shoureshi, K. Youcef-Toumi and H. Kazerooni (Eds.), ASME DSC-Vol. 
6, 261-269 (1987). 

24. L. Meirovitch, Analytical Methods in Vibrations. Macmillian, NY, 1967. 

25. P. C. Hughes, "Space structure vibration modes: How many exists? Which ones are 
important? " IEEE Control System Magazine. 7 (1), 22-28 (1987). 

26. A. Balestrino, G. De Maria and L. Sciavicco, "An adaptive model following control for 
robotic manipulators," ASME J. Dvn. Svst.. Meas.. Contr. . 105 (3), 143-151 (1983). 

27. K. L. Lim and M. Eslami, "Adaptive controller designs for robot manipulator systems 
using Lyapunov direct method," IEEE Trans. Automat. Contr. . AC-30 (12), 1229-1233, 
(1985). 

28. H. Erzberger, "Analysis and design of model following control systems by state space 
techniques," Proceedings of the Joint American Control Conference. Ann Arbor, MI, 
June 26-28, 1968, pp. 572-581. 


20 



Appendix A : Specification of Experimental Properties 


Beam 

Length : 48 in 
Section : 3/16 * 3/4 in 2 
El : 4120 

Material : Aluminum 
Alloy : 6065-T6 


Payload 
Weight : 0.1 lb 
Material : Aluminum 
Alloy : 6065-T6 


Torque Motor 

Manufacturer : INLAND MOTOR 
Type : T-5730 (Permanet Magnet DC) 
Rotor Inertia : 0.06 in-lb-sec 2 
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Figure Captions 


Fig. 1. The one link flexible arm 

Fig. 2. Block diagram of the total control scheme 

Fig. 3. 1st and 2nd mode shapes 

Fig. 4. Joint position profiles (joint velocity to be tracked) 

Fig. 5. Joint velocity profiles (joint velocity to be tracked) 

Fig. 6. End point position errors (joint velocity to be tracked) 

Fig. 7. Control torques (joint velocity to be tracked) 

Fig. 8. Joint position profiles (joint position to be tracked) 

Fig. 9. Joint velocity profiles (joint position to be tracked) 

Fig. 10. End point position errors (joint position to be tracked) 

Fig. 11. Control torques (joint position to be tracked) 

Fig. 12. Joint position profiles (end point position to be tracked) 
Fig. 13. Joint velocity profiles (end point position to be tracked) 

Fig. 14. End point position errors (end point position to be tracked) 
Fig. 15. Control torques (end point position to be tracked) 
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CONTROL OF A MULTI-LINK FLEXIBLE MANIPULATOR WITH A DECENTRALIZED APPROACH 


B. S. Yam, W. J. Book, J. D. Hoggins 

School of Mechanic a l Engineeri ng, Georgia Institute of Te chno l o gy, Atlanta, GA 30332-040$ U-S-A. 


Abxtrafl . This work seeks to provide an effective way Cor the development of the dynamics at a multi-link flexible 
manipulator. Due to the presence of nonlinearities, uncertainty, and Enk flexibility, a decentralized control is 
implemented here to provide robust stability without mcrcamn g the burden of on-fine computation Simulations and 
experimeatt show agreement with the analytic work. 


INTRODUCTION 

The fight weight manipulator arm is a challenging research topic with 
potential to improve the performance of robots and other high 
performance motion systems [Book, 1974; Cannon, 1964]. The mam 
problem with light-weight structures is in the resulting flexible 
vibrations naturally excited as the manipulator is commanded to 
move or is disturbed [Balas, 1978]. Control is one key to effective use 
of fighter manipulators, but its capability is limited by uncertainties 
in the manipulator plant and in the environment. 

The first step in studying s design is establishing a suitable dynamic 
model. An assumed mode representation of the structural deflection 
is combined with a Lagrangian approach to derive the equations. An 
efficient derivation is possible by recognizing that the inertia matrix is 
positive and symmetric, and that nonlinear terms exhibit a skew 
symmetry. The general form of the equations allows the complete 
nonlinear model to be derived from the Jacobian matrix and the 
properties via symbolic manipulation techniques [Yuan, 1969). 


rmwwiKn of flexible arms has been described by 4x4 transformation 
matrices as proposed ia Book [Book, 1964). A point along the fink is 
described in a fixed reference coordinate system by two 
transformations, \ and E,, betweep the coordinate systems. The 
transformation. A,, relates system i , the point before de fl e cti o n , to 
system LLThe transformation E, relates the deflection of system i to 
system i . Note that the transformation which is de s cribe d as the 
poakioo of an arbitrary point attached to the rigid arm has the form of 



R - 3x3 matrix of direction cosines, 
P » position vector. 


A centralized control is possible and a linear quadratic regulator 
using fink strain and joint angle measurements is considered for 
comparison to advanced controllers [Yuan, 1969]. A decentralized 
control, boweveT, wifi have advantages in terms of implementation in 
complex cases. The independent control of the joints of a flexible arm 
is shown to be stable [Yuan, 1989]. Then, an advanced control 
algorithm using a decentralized scheme with bounded plant 
uncertainty is proposed. If the rigid dynamics is dominant, the flexible 
dynamics wifi contribute most to model uncertainly. Alternatively, the 
flexibility of each link can be in c luded in the decentralized models. Link 
interactions then form the major source of uncertainty. 


Therefore, the combined relation is 

K-l - Ej fcj , (12) 

where 

hj - [PT 4p * the position of the point is system L 

Considering the ith consecutive coordinate transformation along a 
serial linkage, we can derive the location (rj of a point along the ith 
coordinate viewed from the base frame, 


The decentralized control scheme assumes the satisfaction of certain 
witch jag conditions [Lehmann, 1961). These conditions guarantee that 
the uncertainty vector does not influence the dynamics more than the 
control input does [Gutman, 1979]. The sigaal-fyatheat adaptation 
approach used here results in a robust stabtfky design which reduces 
the burden of on-fine computation and satisfies the needs of flexible 
arms. The design is based on the Lyapunov criterion [Vidyasagar, 
1978], with the output error between the sy*em and the reference 
model used as the signal of interest 

Simulations and ex p e r im ents are carried out on a two fink teat case 
called RALF (Robotic Arm, Large and Flexible), at the Flexible 
Automation Laboratory at Georgia Tech (Fig. 1). The results 
compare independent joint control and a decentralized adaptive 
controller, when a predefined trajectory is followed. 

DYNAMIC MODELING OF A MULTI-LINK FLEXIBLE 
MANIPULATOR 

To establish a successful feedback control for a mechanical system, 
dynamic modeling is an important prerequisite, la contrast to the 
rigid manipulator, whose equations of motion have been vmfl-devcloped 
[Asa da, 1966; Paul 1961], the distributed-mass character of the flexible 
manipulator needs further explanation. The kinetic and potential 
energies, that are derived using Cartesian coordinates, result in a 
Lagrangian formulation that simply and systematically produces the 
dynamics of a multi-link flexible arm. 


r.-T.'r, 


( 22 .) 


Ti-Ai^AjEj-AmEmA,. (13b) 

and r j is the position vector related to the ith without the 

transformation E* due to fink deflection. 


The flexfele deflection is assumed to be s finite series of separate 
modes which are the product of admissible shape functions and 
time-dependent generalized coordinates. Higher modes are 
comparatively snail in amplitude. With small deflections, the matrix 
E can then be expressed as 


Ef a I 6 


U 


Zlj 


-e 


' 8 zU e yij 


yij xij 


•0 

0 

0 


"a 


xij 1 j 

M 1j 

0 
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i o 
o i 
0 0 
0 0 


(2.4) 


where for fink i * the time varying ampfitude of the shape function, 
v~, and are the x, y and z components, respectively, of the shape 
taction, 0^, 0^ and 0^ are the small rotations of the body-fixed 
coordinate system at the point of interest, is the number of shape 
needed to represent the flrs i h i r kinematics to the degree of 
necsney needed, and is the distance to the point of interest along the 
fat's neutral axis, which is 1+ the lentfh of the fink, when the point at r k 
knot on link L 

Clearly, A^ai taction of the joint displacement fa) and E| is a 
taction of link deflections <* M ). Transformation equation (23) 
ghmmtea the functional relationship between the po si tio n of a point 
fat fcfc bnk and the displa cements of aD joints and hnk deflection 
Evolved in the kinematic chain. Then, consider the kinetic energy of a 
point on the ith link, 

« - f *E, - 

1 J 11nk 1 

* i Tr * c * ( dT “5T ) (25) 

rtert 4r 1* c*Tltd the velocity vector, 
at 

Taking the derivative of the transformation ( 23 a) with reaped to time 

N ■ S * T i S (2#) 

Scmming over all n links, one finds the system kinetic energy to be 


dKE. 


fl 

ICE - 2 

* * 1 •'link 1 


(X6) can also be written as 
f i ' J i * ’ 


(2.7) 


( 2 . 8 ) 


In addition to the computation of the kinetic energy, we need to find 
the potential energy, which arises from three sources as considered 
here: j^**u elasticity, gravity and link deformation. 

We an u-fink manipulator with revolute joints, and model the 

elasticity of the kh join! as an equivalent torsional spring with spring 
coostMal K*,. The formula for this potential energy is 

?i pe ,i-I i - 1 K «i V ’ (212) 

inhere q 4 is the joint coordinate measured from the unstretched 
position <h» to qj. 

The gr av ity energy for a differ e n ti a l ele me n t on the kh fink is 

dPE #1 - - 9 T T i 1 r i da, (2.13») 


where the gravky vector g has the form 

» T " l V 8 y, 9 z, 01 • 


energy ta 


" 8 i 5 i Vi 


(2.13b) 

over aS finks, the total potential 

. (2. 1<0 

(2-Nb) 


Mbcrt h, - M 1 1^+ k I j « i(( E ik 


and Mj - the total mass of fink i, - [0,0,h tl ,l] T - a vedor to the 
of gravity from joint i (undeform ed), 




dn 


The strain energy of fink i is related to the fink deformation integrated 
along the z- axis coinddeat with the fink is described as 


kl ^ f «, 

di 2 J 11nk1 l [ d Z 1 J : 


A . •* 

yl 


a i. 


Jj is the 4xf nx(mii + 1)] matrix, 
X includes all q, sand 6^ s. 

Then, 


m 2 if Tract (X X) da, (2.9a) 

i . I 2 J 11nk 1 

-X T [ .2,4 f Tnc« (j/j,) 8"]*» ( 2 - 9b > 
L 1 ‘ 1 2 ^ 1 Ink 1 1 1 J 


+ V* 1ST 


a 0 


zl 


dz. 


(2.15) 


where E and Eg are Young's modulus and shear modulus of elasticity, 
I, and Ij are the area moments of inertia of the fink, while J K is the polar 


U K1 ■ k S i 4 ,k °1k 


wbert J^ T Is symmetric and positive. 

To ****11" i and j to X, 

f «i J ‘ 0 (2. 

* 1J 1 d 1j J - 1, 2 ■, 


10) 


(23), then, becomes 

““Il-lJ-^Oa-ir^O V X “8 (211) 


V • k Si 4 1k V 1k 


•l«-k5i 4 1k ®z1k 


Note that compression is not initially inc l ud ed as k is generally much 
smaller. 

Then, the total strain energy PEj can be written as 
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where 

K d 1 Jk “ K x 1 jk + Suk + K z 1 Jk 

• • ■! 
HlJa^Pq * 1 J + |i 0 

Kp|q Xp| 4 Gpq 

•w* . 2 . . 2 .. 

where 



xljk 


f dU 1 

ei *77 

Mink 1 1 


<% dU ik 


d Z 


2 dZ 1 


K y1jk t Sljk * <tC ‘ 


f *KE 1 

d f 


*1 


to derive the Lagrangian equation of morion. First, 
md to be obtained (or any coordinate Mate 


%z Ll, ij (2.17) 


1 J • o ijpq ij 


n ■, " "i " !b 

“l 5 l jio"ijpq Vi-i J-» .Si 4*0 


f%E 9 i i 
«** f J X «4 


and 

aicE _ i 

x 

pq 
m 


n ■ 1 n « 
d x *2 1*1 J ■ 0 a -1 fi m 0 


( 2 . 18 ) 


1W 


a x 


pq 


X 1j X *A 


Taking the partial derivative of the potential energies of the elastic joint 
a pff the link deflection leads to 


3(K ♦ PE ) ■, 

* “ . 2 K , x . 

I - o plq p(. 


a x 


(2.19) 


pq 


*plq *' 


( K # q In (2.12) , < • 0 

pi ’ | K*« in ( 2 . 16 ) , -t*«n I * 0 


(2.21a) 


h wpp - ’ I • 

Gjq is the gravity term m (2-20), 

Q n it the generalized force. 

Is matrix-vector form, 

M(X)X H(X,X)X + KX ♦ 6 (X) - Q . ( 2 . 22 ) 

where X is the state variable measured from the reference 
(uastretcbed) position. 

The Mructores of the equations of motion for rigid and flexible robotic 
vnu are very as gh*a above, while the generalised coordinate 

variables are different. Additional variables, namely the deflection 
coordinate 6u, are used to describe the link deformation so that the 
stiffness coefficient K in (2.22) originates from the strain energy. 
Therefore, the condition of a skew symmetry (M * 2H) can be obtamed 
in (2.22) [Yuan, 1989] as it has been found in the case of rigid 
manipulators (Asada, 1966]. 

m. CONTROL ALGORITHM 

Independent linear controllers at each joint, commonly called joint 
proportional-derivative (PD) controllers, have provided adequate 
position control for rigid robotic arms [Asada, 1986], similarly for 
flexible arms [Book, 1974]. The system with flexibility is shown to have 
the passive nature from both the frequency-dominant [Book, 1974] and 
lime-dominant (Yuan, 1969] approaches. This de centr ali z e d approach is 
carried forward with the development of an advanced control algorithm 
ming the d-*-— scheme that treats the overall system as several 
subsystems (local systems). The designer for such systems determines a 
control structure which ““p* inputs to a set of local controllers, and 
observes only local system output. The inter conne c t ing terms between 
subsystems are considered as uncertainties in the system and are 
bounded (Yuan, 1989]. 

In a multi-link flexible manipulator, M(X), the inertia matrix, is 
symmetric and positive definite. Therefore, one can define a positive 
matrix fi such that 


Ul i KV) - 4 l 

where | | 1 $ in Induced nom. 

i (222) can then be te wr i t ten as 


( 3 . 1 ) 


and the grivlty ter* Is 

T n a T. ▼ 

V, 2 -H— h, - g ' T E . q *0 

* i - p 8 x_ i p pq 

( 2 . 20 ) 

, when q-0 


aPE 

t 

T% 


pq 


pq 


n a T 

' 9 ^p^- h < 


X-M‘ 1 (X)(H(X,X)X+KX+6(X)]+4Q+(H* 1 (X)-4]Q (3.2) 

Take each link i as a subsystem and define state variables Zj - [XT, 
ifcf], where the vector X ^ is includes oae joint coordinate and 
generalized deflection coordinates for fink i (2-21). Equation (32) is 
divided into n equations for the n interconnected subsystems. Therefore, 
en^ subsystem is describe d by a first-order differential equation of the 


n a T. aA 

Note that 2 y— “ aT ■ 0 ’ " h,n P-n IBd q *° 

1 ' P 3 *pq 3q n 

FtuDy, caoAonog (2J7), (2.18), (2.19) wd (2J0) *i*t» the equation of 
morion for Xpq: 


Z\ - A \2\ 4 ♦ F< (Z) 4 fi(Z)Uj, 


( 3 . 3 ) 


where 
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« * 1 A-X z - (z,, 

and 

®i - Q* in (111), £i(Z)Uj - the coupling terms of[M A (Xyfi}Q 
for subsystem i. A* is • constant matrix which represeats the linear 

time-invariant part of -M* l (X)K 


r° i ] 

- hi *« J* (3 - 4) 

while Fj(Z) represents the rest of *M* J K and the nonKncar terms of 
•M'lJH ♦ G]. bj becomes a vector form with zero e l ements on the upper 
half. 


^i p i*i 


W - 


Kvii 


^(Z.Pj.Tj). >*en 


"1 


KviK 


b i p i*i 

— j — ^(Z.Pj.Tj). when 


(3.11) 


K p i*i^i 


wher e A< it a prescribed positive cnost a nt and ^ is a positive constant 
which wffl be specified subsequently. 


0) Fj(Z) and fj(Z) are assumed to be bounded and are modrlrd as 
spten uncertainties assumed to have the properties [Lefcmasa, 1961] 

FKZjtFjCZ fi) (3J«) 

VZ)U(Zfl) (ISb) 

where OfR r represent the system uncertainty and is continuous on R p 
as well as the uncertainty bounding set 
(n) (A^bj) h controllable. 

(ui) There exist matrix functions Dj(*) and Ef(*) such that 
F^) - bp t (Zfi) (3^a) 

tiCZfi) - b£(z^) (3JB>) 

where |e| < 1 from (3.1) 

A model reference control with signal-synthesis adaptation is 
implemented here and the satisfaction of the matching conditions (3.6) 
is assumed. These conditions guarantee that the uncertainty vector docs 
not tnfltiengg the dynamics more than the control input does [Gutman, 
1979]. The objective of model reference adaptive control is eliminate the 
state error between the plant and the reference model so that the 
behavior of the plant follows the modeL Consider the reference model 
first. 


Aa a result, the error dynamics of the subsystem is derived from the 
difference bet ween equations (33) and (3.7) along with (331) and (3.6): 


•i " %i*i * b i ( *i * *V * <»•»*>) 

Mhtrc 

w t - 0 1 +E 1 (k2 1 z i ♦ k b1 7 1 + #,)• (3.12b) 

Gives the boundedness of the male variable z, and the r eferen ce input 
7p equations (3.11) and (3.12b) give the following inequality: 

hj i 0,(2* v V (313,) 

where 

F i (2.e i T i )t|0 i (2)|+|E i (Z)|(|K z1 2 i | 

(3.13b) 

+ l K b1 z ,M*1 ( * i ) l ) 

The definition of p x in (3.13b) is valid; Le. (3.13) can be solved since 
(3.1) is *ii*R*A Therefore, we have 


z .i • A .1 2 „i ♦ b .1 ¥ 1 • 

(3.7) 

1^1 l) _1 t l°i hlEi !( N z i ll z i 1 


where 


(3.14) 

z .»[x . |X J and Is the reference Input, 

wl 1 m\ n1 J 1 

♦IkJItJ)] 


And let 

*■1 * A 1 + b 1 K zl 

(3.8.) 

To insure that the error dynamics (3.12) is uniformly bounded, the 
approach relies on the Lyapunov criterion [Vidyasagar, 1978]. Given a 

Lyapunov function candidate 


b .1 * b 1 K b 1 

(3.8b) 

T 


where K* and K* are t matrices of compatible dames 

a stable matrix satisfies the Lyapunov equation, 

tskm. Also, 

¥ <V • # i p i*i 

(3.15) 



and there exists 


A w1 P 1 + P 1 A «1 “ L 1 

(3.9) 

» - .{p,., ♦ .{ P,e, 

T J 

(3.16) 

where P, and L> are positive dgfin** and symmetric matrices. 



The signal- synthesis method (Landau, 1979] implemented here seeks to 

* • # 1 L 1 , 1 - VlVVV 


control the system by adjusting the input u which is as described in the 

7 


following equation 

u i ’ K n z i ♦ Si b + W 

(3.10) 

T T T ^1^1*1 

1 • 1 L < t 1 21^ P i « 1 l [# 1 * T . 'i 1 

• b 1 P 1 * 1 * 

• 


Consequently, V < 0. 

where Cj - z^, - z, is referred to as state error and the function ^ it the 
control input to compensate the system uncertainty. Thus, let be 


V 



Fu rthe rmore, the error dynamics of the tool system as be proven to be 
cubic by summing the individual Lyapunov function [Yuan, 1989). To 
improve the co nv ergen ce rate of equation (3.12), an auxiliary input w (l) 
k introduced and applied to the input u, in (3.102) [4,13]. This input is 
effectively an integral action. Thus, 


35* and the second joint of 109*. Therefore, the comtini gams (K^) 
are obtained as [Yuan, 1969]. 

K* - [-182E7 -L35E4 -2-80E5 -L14E3] (4.1a) 

K j2 »(*3jCIGE 7 -L01E4 -7.76E4 -168E2] (4.1b) 


“i ■ Si s * Si s + s + -i 


where 

'i 


-i j 


- -« t •*, ♦ S, b, P t 


< 4A 1 s • wmM > 
“ ,2 *wvhi 2 


V° 


Note that represents the minimum eigenvalue. 


(3.17) 

(3.18.) 

(3.18b) 


while the gams associated with joint positions and velocities are needed 
to specify a joint PD controller as follows: 


u - -K p q - 
r 2.82E7 

K p"[ 0 1 

f 2.8E5 

V[ 0 

Equation (3.1) needs to be satisfied in deriving b, such that is here 
ns the inertia matrix with the interconnecting terms of zero, bj 
and bj are, thus , 


0 1 

3.0E7J , 

° l 

7.76E4J 


IV. SIMULATIONS AND EXPERIMENTS 

In the previous section, the dynamic model of motion for a multi-link 
flexible manipulator has been derived and the control algorithm 
implemented here has been proven to be theoretically feasible. 
Computer simulations and physical experiments should be carried out 
to test the work. A computer-controlled prototype two link m an ip ula t or, 
pat F with a parallel actuation mechanism, driven by hydraulic rams is 
iw»<i to perform this verification. Each link is a cylindrical hollow beam, 
tea feet long. The parallel mechanism's function is force tra nsmiss ion 
to the upper hnk. The weight of the robotic structure k about seventy 
pounds. More details are given [Yuan, 1969]. 

The transformation matrix E 1 contains deflection dis p la cem ents and 
rotations as a function of position 1 along the link. The spatial 
dependence of these deflections, their shape, is theoretically required 
only to meet modest restrictions at the link boundaries in an infinite 
order model. A finite element approach was used to in thk research to 
the from detailed models of the Hnk geometry and 

material properties. Of crucial importance to the accuracy of s low 
order model are the boundary conditions applied in deriving the shapes. 
E q uiva lent springs were used to represent the actuators for both li nks 
Equivalent masses and inertias were also placed at the end of each Hnk, 
yi el ding boundar y conditions on each link [Yuan, 1969]. The parallel 
mechanism is sim plied as a corresponding spring so that equations of 
motion as given in (2-22) are obtained. 

A Micro- Vax □ running under the VMS operating system k used to 
provide high-speed calculation during real-time control and data 
acquisition. The control program is written in Fortran and the 
resolution of D/A and A/D k 12 bits/10 vok. It results in sampling 
and calculation time of 7 ms. When the advanced control k applied, 
computation time k increased by ap pro xim a te ly 1 ms to a total of 8 
ms. However, thk sampling rate k feasible to control the RALF since 
the bandwidth of both bydrauHc actuators k above 45 Hz and the 
lowest two frequencies of the RALF are 5.69 Hz and 9.12 Hz, while 
the higher mode frequencies are hardly measurable. The third mode 
primarily consktiag of vibration of the actuating Hnk k about 30Hz, and 
can not be controlled. 


’ 0 

0 

0.002 

-0.259 


0 

0 

0.0373 * 

-5.267 


(4.3) 


(4.3) 


The value of p, in (3.11), k related to assumed uncertainties by (3.14). 
fi i k set to be 3.05E5 from the engineering viewpoint; and the value of 
k 2.0. For the decentralized adaptive controller, S, is chosen to be 
333E-3 , while <*, k simply set to zero. 


The end point of each Hnk k mowd about 8.5 inches in 0.4 seconds for 
point-to-point control. Figures 2*Jb show the joint (error) responses 
nod Figures 2c, d represent the strain responses in simulations. 
Obviously, the decentralized adaptive control results in the best 
performance in the joint position tracking as well as flexible link 
damping, while the joint PD control displays the low relative stability of 
that feedback system. When the controller is implemented in the 
experiments, the gains are scaled to match the physical characteristic* of 
the system. The Figures 3a,b show time responses of the joints with a 
FD controller and with an adaptive decentralized controller. Figures 
4a,b and 5a^> illustrate the strain responses o ccur r e d is the lower and 
the upper Hnks with different controllers. The decentralized controller 
settles in leu than 1/3 the time needed by the PD controller. 


The results from simulations can be compared with ex pe rim ents to 
flhutrate qualitative agreement, la light of model simplifications the 
deviation between the experiment and the shnnlatinn should, however, 
be tolerable. 


V. CONCLUSIONS 


The measurem ent of the piston position is used for f ee dback in s te a d of 
the joint angle. A variable differential transformer (LVDT) k 

the transducer. Ffra u v the LVDT k located at the same p o sit io n as the 
actuator, the non collocation problem existing in the feedback control of 
flexible structures can be avoided [Bales, 1978]. Strain gages moated 
■ear the base and midpoint of each Hnk provide m e a sur e m e N s of the 
link deflections. The servo valve of the hydraulic actuator k driven by a 
power amplifier based on the voltage sign a l 

The controller design is carried out morning no payload on the end and 
the configu ration of the RALF at 'home* position; Le„ the first joint of 


An effective approach based on Lagrange's formula and the assumed 
mode method has been developed to derive the dynamical equations of 
• multi- Hnk flexible manipulator. By applying positive control gains Kp 
and Kq cm individual joint position and velocity feedbacks, the system is 
known to be stable. Thk simple ind epen dent joint control leads to an 
adaptive scheme to improve the co n v er g en ce rate. In the 

experiments, time responses show compatibility with the theoretical 
anafysk and simulation. The vibration h damped out in under 2 cycles. 

Long distance motion and variations of payload must be performed in 
the experiments in order to lest control robustness. 
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